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1.  INTRODl  CTION 


A.  Research  Objectives 

The  purpose  of  this  study  was  to  develop  a science  for  the 
design  of  computer  controlled  manipulator  systems  which 
could  be  scaled  for  small  manipulators.  At  the  outset  of  the  study  the 
lack  of  specific  tasks  or  the  specific  scale  of  a design  environment 
forced  consideration  of  a working  volume  consistent  with  pecpie  in  order 
to  determine  the  relationships  between  tasks,  task  scale  and  performance 
requirements  for  actuators,  sensors  (both  force  and  position),  etc. 

The  W'ork  therefore  had  four  principal  activities,  namely: 

a.  establish  a scientific  base  for 
determining  manipulator  require- 
ments as  a function  of  task  and 
task  scale 

b.  identification  and  development 
of  general  design  tools  needed 

c.  implementation  of  a design  for  a 
laboratory  system  to  determine 
the  validity  of  the  approach 

d.  evaluation  of  design  concepts  via 
simulations  and  small  laboratory 
experiments 

In  addition,  a survey  was  made  of  existing  manipulator  systems 
and  a novel,  patentable,  hydraulic  actuator  was  conceived  and  documented. 

1.  Arm  Design  Considerations 

Arm  design  is  really  a misnomer.  One  cannot  consider  an 
arm  out  of  context  of  the  tasks  expected  to  be  performed  or  the  environ- 
ment that  the  tasks  will  be  performed  in.  For  example,  Figure  1-1 
diagrams  the  interlationships  that  must  be  considered  between  technology, 
environment,  parts  design,  and  task  descriptors  if  the  focus  is 
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b'igurc  1-1  Interaction  of  Klements  in  Assembly  System  Design 


manipulator  systems  tV»r  assemhls  in  a mani.factunnfi  envimi, 

Hosirlfs  these  issues,  other  studies'1*  2>ha\«- 
shown  that  thr  definition  of  industrial  assembh  requires  ronsidera- 

* ton  °f  a whoU*  s»*‘r,ri,m  “*<  Asides  rrrot  ton  sistcrns  as  ,11ms, rated 

In  I able  1.  Ir,  general,  mo-, on  or  manipulator  s\  stems  must  be 
concerned  with  fetching  parts,  holding  parts,  and  assembling  parts. 

These  alone  implv  mam  degrees -of-treerlom  not  normalK  considered  rn 
the  simple  arm  req  moment  that  the  end  point  of  the  manipulator  he  able 
•o  achieve  a!'  possible  state  points  rn  sor,c  arbitrary  working  volume. 

I irther.  these  studies*1'  showed  that  the  three  tasks  /fetching 
parts,  holding  parts,  and  the  assembly  proc  ess)  can  be  categorized  into  press 
and  fine  motions,  (moss  motions  are  the  larpe.  rapid,  less  accurate  motions 
necessary  to  mow  objee  ts  from  one  loc  ation  to  another . I he.se  motions  . an 
usually  be  don-  in  an  open-loop  control  manner  with  minimum  informa- 
tion required  from  the  em  ironment.  Fine  motions  are  the  small  precise 
motions  needed  when  two  objects  interact.  It  m this  latter  motion  which 
is  most  dependent  on  the  information  acquired  from  the  environment. 

An  interface  region  has  also  been  defined  between  pross 
motion  and  fine  motion  to  identify  the  boundary  of  uncertainty  in 
knowledge  of  the  location  of  parts,  their  size  variation  or  the 
imprecise  technology  (sensor  arrays,  mechanical  systems, 
control  strategies,  etc.  ) available  for  accomplishing  the  desired  motion. 

For  other  tasks,  other  considerations  as  well  as  the  above 
must  be  taken  into  acco  :m.  Two  thumbnail  design  scenarios  might  serve 
to  illustrate  these  points.  Suppose  one  wishes  to  use  a small  arm  (50  cm 
reach)  to  remove  or  insert  common  integrated  circuits.  It  is  known  that 
each  pin  on  such  a circuit  module  requires  a force  of  about  200g  to  insert 
it.  Thus,  a common  8 pin  modi  le  will  require  1.6  kilogram  of  force  at 
the  hand  or  0.  8 kilogram-meter  of  stall  torque  at  the  shoulder  of  the  arm 
which  does  the  inserting  or  removing.  This  stipulates  a minimum  static 
strength  for  this  actuator.  Other  actuators  with  axes  parallel  to  this  one. 
at  the  elbow  or  wrist,  will  havr  *o  be  capable  of  correspondingly 
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I ABLE  1 ASSEMBLY  SYSTEM  ELEMENTS 


(1)  PARTS  MANAGEMENT,  GROSS  AND  FINE 

Gross  (scheduling):  inventory  orders,  conveyors, 
dispatchers,  etc. 

Fine  (parts  feeding):  shakers,  conveyors,  etc. 

(note  the  trend  to  make  parts  on  site). 

(2)  INSPECTION,  EXPLICIT  AND  IMPLICIT 

Explicit  (are  all  the  holes  present?) 

Implicit  (do  the  parts  go  together  as  expected?) 

(3)  MOTION,  TO  BRING  THE  FED,  INSPECTED  PARTS  TOGETHER 
POSSIBLY  USING  JIGS  AND  FIXTURES 

(4)  FASTENING,  USING  SCREWS,  RIVETS.  GLUE,  ETC. 

(If  not  glue,  then  fastening  involves  additional 
assembly  tasks). 

(5)  NON-DESTRUCTIVE  TESTING  (e.g.,  TEST  FOR  FREE  MOTION). 

(6)  DIAGNOSTICS 

(If  some  assemblies  fail,  find  out  why  and  correct  parts 
manufacture  or  assembly) 

(7)  MONITORING 

(To  determine  if  the  assembly  system  is 

operating  properly) 
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aic  lated  stall  torques.  A separate  calculation  is  required  for  the 
torques  required  to  accelerate  and  decelerate  the  arm.  See  below. 

Here  it  sufficies  to  say  that  the  specified  payloads  are  a tiny  fraction  of 
the  arm's  total  weight,  which  therefore  governs  the  dynamic  and  gravity 
torque  problem  independent  of  payload.  If  speed  is  not  a factor,  then 
insertion  forces  will  determine  the  actuator  characteristics. 

As  a second  example,  consider  the  arm  studied  in  detail  in 
this  report  (Fig.  1-2).  Here,  payloads  will  be  a substantial  fraction  of  the  arm's 
weight,  perhaps  20%  to  30%.  This  percentage  is  beyond  the  capabilities 
of  current  industrial  robots.  Their  efficiency  of  design  might  yield  only 
10  to  15%.  That  is,  their  arms  are  quite  heavy  in  comparison  to  the 
objects  they  are  designed  to  move  about.  High  speeds  and  payload 
requirements  dominate  the  torque  sizing  problem  for  the  arm  designed  here,  far 
exceeding  gravity  or  insertion  forces.  It  is  possible  to  solve  this 
problem  badly  and  end  up  with  unbalanced  capabilities  among  the  actuators. 

Weak  wrists  are  common  among  commercial  industrial  arms.  Procedures 
for  avoiding  such  difficulties  are  given  in  this  report,  along  with  the 
necessary  technology  of  actuators,  actuator  location  and  transmission 
methods,  and  computer  techniques  for  performing  the  balance. 

Similar  calculations,  based  on  arm  size  and  task 
characteristics,  are  required  to  determine  the  accuracy,  and  therefore 
the  technology  required  for  joint  position  sensors.  Technology  limitations 
in  sensors  and  structure  may  lead  to  the  conclusion  that  a single  arm 
cannot  be  built  which  simultaneously  has  the  required  reach  (a  gross 
motion  characteristic)  and  the  required  accuracy  and  ability  to  make 
very  small  motions  (fine  motion  characteristics).  A properly  designed 
system  capable  of  dealing  meaningfully  with  such  a task  would  therfore 
consist  of  two  or  more  mobility  systems. 
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2.  Design  Method 

To  deal  with  this  problem  in  a systematic  way,  therefore, 
required  detail  consideration  of  manipulator  tasks  and  an  environmeni. 

With  contractor  agency  support  it  was  decided  to  use  the  deta.Ted  task 
and  environment  analysis  being  done  under  an  NSF  sponsored  research 
grant  into  "Exploratory  Research  in  Industrial  Modular  Assembly.  "(1*  2) 

This  work  was  concerned  with  a system  organized  about  force 
and  torque  sensor  arrays  for  performing  industrial  mechanical  assembly 
within  a working  volume  of  0.3  meter  cubed  (1  foot  cubed).  This 
approach  for  assembly  is  similar  to  the  way  a blind  person  might  assemble 
things  — by  touch  and  feel,  in  order  that  this  kind  of  system  be  efficient 
its  world  must  be  highly  structured.  That  is,  the  location  of  parts,  jigs, 
tools,  etc.  must  be  known  a priori  to  some  tolerance.  Otherwise,  a 
great  deal  of  time  would  be  required  to  grope  around  and  find  things. 

Groping  around,  or  a less  structured  world,  was  left  to  later  considerations 
of  higher  level  systems  that  include  visual  or  non-visual  imaging  sensors. 

The  decision  to  use  the  NSF  sponsored  work  had  the  following 

advantages: 

a.  It  was  concerned  with  a work  volume  in  which 
tasks  can  easily  be  identified  and  studied. 

t.  It  gave  access  to  detailed  task  analysis  being 

performed  on  a variety  of  mechanical  assemblies. 

c.  Since  assembly  is  a composite  of  many  kinds 
of  tasks  the  lack  of  task  specificity  would  not 
be  a problem. 

d.  The  dynamic  coupling  of  manipulator  require- 
ments and  task  and  task  scale  could  be  analyzed 
to  determine  the  design  tools  needed. 

* NSF  Grant  No.  GI-39432Xand  GI-43787 
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Design  Goals  for  a Research  Arm 


The  principal  activity  of  this  work  was  to  implement  a research 
tool  (arm)  for  determining  the  validity  of  the  approach  taken.  The  design 
goals  were  as  follows- 

a.  examine  the  dynamic  geometry  requirements  for  motion/ 
manipulator  systems  for  a variety  of  tasks  and  task  scale 

b.  determine  both  the  static  and  dynamic  relationship  between  the 
requirements  for  actuators,  sensors,  kinematics,  structures 


and  task  and  task  scale 


explore  various  task  execution  strategies  and  the  associated 
envirorment-task  related  information  needed  and  assess  the  impact 
which  strategy/ information  have  on  arm  performance  requirements. 


What  was  found  was  that  the  design  effort  for  this  research  tool 
became  the  prime  focus  for  all  the  other  work.  That  is,  arm  design 
clearly  identified  the  performance  that  could  be  obtained  and  this  in  turn 
sharpened  the  categorization  of  the  gross  and  fine  motion  regions  and 
caused  an  interface  region  to  be  defined  that  encompassed  the  combined 
uncertainties  of  the  technology  and  the  pieces  to  be  assembled. 


The  following  conclusions  could  therefore  be  drawn  from  this  activity- 

a.  arm  design  requires  a use  context 

b.  context  provides  scale,  speed,  loads,  accuracies  - also 
strategies,  information,  (system  organization?),  and  servo 
sensor  loop  closure 

c.  both  design  and  use  are  not  well  understood  disciplines 

d.  parallel  development  of  each  discipline  stimulates  both  and 
identifies  the  real  world  constraints 

e.  developments  at  this  level  provide  the  lower  order  systems 
necessary  for  interacting  with  an  environment  and  coupling  it 
with  eventual  high  order  artificial  intelligence  planning  systems 

f.  it  would  appear  that  the  existence  of  technologically  real  lower 
order  systems  would  aid  and  stimulate  the  development  of 
effective  and  realistic  higher  order  planning  systems  just  as 
consideration  of  task  contexts  stimulates  the  development  of 
lower  order  systems. 
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C.  Report  Organization 


In  six  major  sections  this  report  discusses  a survey  of  existing 
arms  (Section  II),  basic  trade  offs  and  considerations  in  arm  design 
(Section  III),  the  technical  aspects  of  design  and  design  tools  for  a 
scientific  approach  to  arm  design  (Section  IV),  discussion  of  the  Draper 
Lab.  Arm  Design  which  has  been  nick  named  POPEYE  (Section  V), 
details  of  POPE\E's  specification  (Section  VI),  and  SectionVII  POPEYE's 
subsystems. 

A wooden  mockupo.”  POPEYE  shown  in  its  actual  mounting  is 
illustrated  by  Figure  1-2. 
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II.  SURVEY  OF  EXISTING  ARMS 


A.  Purpose  of  Survey 

The  ultimate  goal  of  this  research  was  to  gain  knowledge 
applicable  to  the  design  and  use  of  very  small  robot  arms  for  miniature 
assembly  tasks.  It  was  decided  that  a larger  size  would  be  more 
appropriate  as  a start  to  bring  out  the  generic  problems,  since  very 
small  arms  pose  some  special  design  difficulties  as  well  as  general 
ones. 

A survey  of  existing  robot  arms  was  undertaken  to  see  what 
could  be  learned.  We  were  interested  in  how  such  general  problems 
as  servo  control,  kinematic  configuration,  actuator  type,  transmissions 
and  angle  readouts  were  attacked.  We  also  needed  to  know  if  any 
existing  robot  could  be  utilized  to  test  assembly  strategies.  This  would 
be  useful  for  parallel  work  going  on  as  well  as  showing  how  the 
problems  of  implementing  such  strategies  influenced  arm  design.  The 
survey  therefore  concentrated  on  accuracy,  payload  and  speed 
characteristics  suitable  for  man-sized  tasks.  (No  commercial 
industrial  mini-robots  vere  available  at  the  time  the  survey  was  conducted.  ) 

B.  Criteria  for  an  Arm 

The  criteria  used  for  the  design  of  an  arm  are  given  elsewhere  in 
this  report  (e.  g. , see  Sections  III  & VI).  It  suffices  to  say  here  that  the  static 
characteristics  (size,  reach,  stiffness,  load  capacity,  etc.)  of  an  arm  are 
determined  by  the  nature  of  the  assembly  task  (size,  weight,  etc.  ) and  the 
dynamic  characteristics  are  determined  by  how  fast  the  assembly  is  to  be 
accomplished.  Also,  it  was  assumed  at  the  outset  that  the  six  degrees  of 
freedom  needed  for  assembly  could  not  be  divided  up  between  an  arm  and 


* NSF  Grant  GI  39432X  and  GI  43787 
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a pallet  orienter.  The  requirement  that  the  arm  retain  all  six  degrees  of 
freedom  would  make  it  simpler  to  couple  into  an  existing  assembly  line. 
Extra  degrees  of  freedom  in  a pallet  orienter  are  not  ruled  out,  of  course. 

C.  Sources  of  Information 

The  information  for  this  survey  came  from  three  sources: 

1.  "industrial  Robots  - A Survey",  published 
by  International  Fluidics  Services  Ltd.,  1972 

2.  "The  Robots  Are  Here",  Assembly  Engineer- 
ing, Vol.  15/No.  4,  April  1972 

3.  Information  direct  from  the  robot  manufacturer 
in  the  form  of  brochures,  drawings,  and 
specificiations. 

Source  number  1 was  originally  a Swedish  report  but  was  updated  and 
enlarged  by  Dr.  Brian  Rook  of  the  University  of  Birmingham.  This 
survey  is  especially  useful  for  information  concerning  the  many  robots 
being  built  in  Japan.  Sources  2 and  3 were  used  to  gather  information 
on  the  robots  built  in  this  country. 


D.  Survey  Results 


Some  of  the  data  sheets  for  the  robots  that  looked  interesting  are 
included  in  Appendix  1 of  this  report.  An  interesting  robot  is  me  that 
satisfies  any  one  or  more  of  the  requirements  of  load  capacity  C>  10  kgm), 
accuracy  (<  1 mm),  or  number  of  degrees  of  freedom  C>  6).  The  list  shown 
in  the  appendix  is  not  intended  to  be  exhaustive.  On  the  contrary,  there 
are  many  more  robots,  especially  from  Japan,  with  similar  characteristics. 
To  get  a more  exhaustive  survey  the  references  cited  above  should  be 
consulted. 
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From  an  examination  of  the  available  data  on  industrial  robots 
one  can  make  the  following  observations. 

1.  Arm  and  Wrist  Motions 

With  few  exceptions  industrial  robots  accomplish  the  three  trans- 
lational degrees  of  freedom  necessary  for  arm  motion  using  either  cylindrical 
(r,  0,  z)  or  spherical  (r,  o,  0)  coordinates.  Typical  examples  of  these 
are  shown  in  Figure  11-1.  Also  shown  in  these  figures  is  the  general  outline 
of  the  work  volumes.  These  motion  geometries  optimize  the  quantity  of 
wo-k  volume  for  a given  base  size.  Furthermore,  these  work  volumes 
are  optimized  for  the  work  volumes  normally  used  by  humans  while  work- 
ing at  machines  currently  found  in  industry.  For  example,  the  sequential 
task  — (a)  pick  up  piece  from  incoming  conveyor  line,  (b)  place  piece  in 
machine,  (c)  place  piece  on  outgoing  conveyor  line  — is  a typical  task 
well  suited  to  the  work  volume  geometries  of  these  robots. 

The  wrist  motions  are  limited  to  one  and  two  degrees  of 
freedom  making  the  total  number  of  degrees  of  freedom  four  or  five. 

The  exceptions  to  this  are  the  UNIMATE  MK.  II,  both  series  2000  and 
4000,  and  a few  of  the  Japanese  designs. 

2.  Control 

Control  for  these  industrial  robots  runs  the  range  from 
energy  absorbing  mechanical  stops  coupled  with  simple  relay  sequential 
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Figure  II- 1.  Illustrating  Robot  Motion  Geometries  and  Work 
Volume. 
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logic,  to  continuous  path  control  employing  position  feedback,  electronic 
memory  (e.g. , magnetic  drum,  tape,  or  wire)  and  logic  circuits.  Most 
controllers  are  the  so-called  point-to-point  variety,  where  each  degree 
of  freedom  is  commanded  to  move  in  sequence.  The  effect  of  this  is  that 
the  robot  hand  moves  in  a sequential  series  of  straight  lines  or  circles. 

The  advantage  of  this  type  of  control  is  that  it  is  conservative  of  memory 
locations,  potentiometers,  etc. 

In  one  of  the  more  sophisticated  control  systems  the  robot  is 
taught'  by  leading  it  through  the  desired  task  pattern  while  recording 
the  desired  positions  in  memory.  Three  classes  of  position  entries  can 
be  recorded;  low  accuracy,  intermediate  accuracy,  and  high  accuracy. 

The  first  two  are  used  at  intermediate  points  in  the  task  pattern  so  that 
the  servos  do  not  have  to  slow  or  stop  when  passing  through  these  points. 

The  high  accuracy  entry  of  course  brings  the  arm  to  a stop  and  positions 
it  to  its  rated  accuracy.  A schematic  of  this  system  is  shown  in  Figure  11-2. 
The  hand  held  teach  controller  allows  the  task  programmer  to  get  close  to 
the  task  stations  so  that  he  can  make  more  accurate  entries. 

3.  Power  Actuators 

Most  available  industrial  robots  employ  either  hydraulic  or 
pneumatic  actuators.  Most  of  these  are  in  the  form  of  pistons  which  are 
directly  connected  or  coupled  through  rack  and  pinion  gears  and/or 
sprocket  chains.  A few,  such  as  the  Sundstrand  and  the 
experimental  "Scheinman  Arm"  use  electric  motors  and  gearing. 

4.  Hands  (End  Effectors,  Grippers) 

A study  of  the  hands  used  with  the  various  robots  is  also  a 
study  of  the  various  tasks  that  these  robots  have  been  put  to.  Each  robot 
comes  with  one  or  two  "standard"  hands  usually  in  the  form  of  two  finger, 
parallel  grippers.  However,  many  of  the  tasks  have  special  attributes 
about  them  (Geometry,  fragileness,  surface  texture,  etc. ) that  require 
special  tooling  at  the  hand.  Because  of  this, most  arms  come  with 
mechanical  interfaces  at  the  wrist  that  allow  for  quick  removal  and 
replacement  of  hands.  Source  1 above  has  an  excellent  review  of  some 
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Figure  II-2.  Unimate  Industrial  Robot 


of  the  hand  designs  that  have  been  employed  (see  pages  8-10  of  Source  1). 

5.  Areas  of  Application 

Since  the  passage  of  the  Occupational  Safety  and  Health  Act  of 
1970  (OSHA)  many  tasks  previously  done  by  humans  are  now  being 
automated.  As  OS11A  standards  extend  to  cover  other  tasks  more 
opportunities  will  offer  themselves  for  automatic  equipment.  Many  of 
these  tasks  fall  within  the  domain  of  capability  of  the  industrial  robot. 

This  is  especially  true  for  tasks  that  are  monotonous  or  involve  dangerous 
environments.  Examples  are:  conveyor  line  feeding,  unloading  die 
casting  machines;  servicing  machines  such  as  machine  tools,  presses, 
stakers,  punches,  riveters.  These  tasks  are  easily  handled  by  point-to- 
point  or  continuous-path  controlled  robots.  Tasks  such  as  spray  painting 
and  spot  welding  require  robots  with  continuous-path  controls. 

E.  Robot  Assemblers 

Very  little  has  been  accomplished  in  the  area  of  assembly  using 
presently  available  industrial  robots.  Exceptions  to  this  observation  are 
notable  in  the  following  areas. 

1.  Using  a specialized  tool  in  the  place 

of  the  robot  hand,  two  parts  are  fastened 
together.  Examples  are:  screw 
machines,  nut  runners,  pop  riveters,  and 
spot  welders. 

2.  Using  fixtures  and  gravitational  force, 
two  or  three  parts  are  stacked,  then 
loaded  or  held  in  a fastening  machine 
such  as  a staking  or  riveting  machine. 

3.  A combination  of  1 and  2. 

These  assembly  techniques  will  get  greater  use  as  more 
subassemblies  are  deliberately  designed  or  redesigned  so  as  to  take 
advantage  of  the  assembly  capabilities  of  present  arms.  Likewise  as 
arm  designers  produce  faster,  stronger  (greater  pay  load)  and  more 
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precise  (greater  positional  accuracy)  arms  the  range  and  variety  of  assembly 
tasks  amenable  to  solution  by  the  use  of  industrial  robots  will  become  very 
much  greater. 

Even  greater  numbers  of  applications  will  present  themselves 
when  the  industrial  robot  it,  designed  to  take  into  consideration  the  special 
needs  of  the  assembly  process  as  well  as  the  large  scale  mobility  needs 
common  to  many  pick  and  place  applications.  Reaching  out,  grabbing  a 
part,  and  moving  it  to  a new  location  often  represent  only  the  initial  phases 
of  an  assembly  task.  For  example,  the  control  of  small  motions  the  direc- 
tion of  which  is  being  determined  by  the  interactive  force  between  the  two 

pieces  being  assembled  (active  accommodation)  might  be  the  next  phase 
required  for  successful  assembly.  The  next  phase  may  be  to  switch  control 
modes  such  that  the  two  pieces  being  assembled  are  allowed  to  guide 
themselves  together  along  their  mutually  interacting  surfaces  (passive 
accommodation).  It  may  be  recognized  that  this  example  describes  the 
task  of  putting  a peg  in  a hole,  one  or  both  having  chamfered  ends. 

The  point  being  made  in  the  previous  paragraph  is  that  the  next 
generation  industrial  robot  that  is  designed  for  the  express  purpose  of 
assembly  will  have  to  have  the  attributes  of  an  assembler  as  well  as  a pick 
and  place  robot.  Greater  accuracy,  pay  load  range,  dexterity,  and  speed 
will  be  required.  The  incorporation  of  accurate  position  and  sensitive  force 
feedback  will  also  be  needed.  The  Sections  which  follow  discuss  the  major 
system  and  component  design  problems  involved  in  creating  high  performance 
assembly  robots.  Only  the  general  aspects  suitable  for  all  sizes  of  arms 
are  discussed.  No  attention  is  given  to  the  special  problems  which  very 
small  size  presents. 


See  Section  UI-D. 
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111.  BASIC  TRADEOFFS  AND  CONSIDERATIONS 

rcraKM  bESIOT 

A.  Introduction 

This  section  of  tl._  report  discusses  the  issues  which  influence 
arm  design,  and  describes  (but  does  not  solve)  various  technical  problems 
and  tradeoffs  which  must  be  considered.  Section  IV  presents  technical 
solutions  in  the  form  of  tools  applicable  to  the  design  of  arms  in  a wide 
range  of  sizes.  These  matters  are  discussed  in  reference  1 as  to  their 
effect  on  assembler  system  architecture  and  for  'he  insight  they  yield  into 
the  assembly  problem  in  general.  Here  they  are  discussed  to  show  how 
they  impact  the  design  of  an  arm  and  give  rise  to  specific  design  approaches 
and  design  tools  for  specifying  and  evaluating  assembler  arms. 

B.  The  Assembly  Problem  and  Its  Impact  on  Ann 

Design 

Figure  111-1  is  an  attempt  to  organize  the  processes  and  methods 

5«j 

of  assembly  . The  process  is  described  in  two  stages,  parts  presentation 
and  assembly,  the  two  separated  by  the  point  at  which  the  part 
is  interfaced  firmly  to  that  portion  of  the  assembly  device  which  carries  the 
part  to  its  final  destination  in  the  assembly  and  assembles  it.  According 
to  this  definition,  everything  else  is  parts  presentation.  The  boundary 
between  parts  presentation  and  assembly  occurs  for  manual  assembly 
approximately  at  the  point  where  the  person  grasps  the  part  from  the  bin, 
conveyor  or  whatever,  except  in  some  cases  where  the  person  reorients 
the  part  in  his  hand  or  places  the  part  in  an  assembly  tool  or  fixture. 

For  fixed  automation,  it  would  appear  that  the  entire  process  is  really 
part  presentation.  This  is  especially  evident  in  bowl  feeding  of  small 
parts,  where  the  feeder  removes  uncertainty  of  the  order  of  a meter  and 
replaces  it  with  uncertainty  on  the  o ler  of  half  a millimeter. 

The  entire  assembly  process  appears,  in  fact,  as  a staged  process 
of  removal  of  uncertainty  until  positions  and  orientations  are  known  with 
enough  certainty  so  that  assembly  can  occur.  This  does  not  necessarily 
mean  that  uncertainty  is  removed  merely  by  navigation.  This  is  clearly 

* Many  items  on  this  figure  are  estimates. 
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not  true  for  manual  assembly,  because  people  cannot  navigate  objects  open 
loop  with  sufficient  accur  acy.  The  ability  of  force  feedback  to  reduce 
uncertainty  by  testing,  taking  data  during  attempts  at  assembly,  is  one  of 
our  research  topics,  and  a major  question  is  where  the  boundary  between 
part  presentation  and  assembly  can  be  placed  for  the  purposes  of  force 
feedback  assembly.  The  farther  to  the  left  on  Figure  III- 1 it  can  be  put, 
the  better,  because  this  reduces  constraints  on  part  feeding  mechanisms, 
although  it  puts  added  burdens  on  the  strategy -making  process  of  evaluating 
the  force  feedback  data.  It  also  removes  much  of  the  physical  hardware 
used  for  uncertainty  removal  by  fixed  automation,  freeing  the  assembler  to 
be  reprogrammed  to  do  other  tasks. 

It  would  appear  from  our  studies  of  a washing  machine  gearbox 
that  its  internal  uncertainties  are  so  smal  that  once  the  parts  are  brought 
to  final  positions  to  within  that  uncertainty  then  assembly  will  occur.  This 
is  clearly  the  strategy  inherent  in  fixed  automation,  and  seems  to  be 
successful  on  carefully  machined  items  like  the  gearbox,  small  engines, 
and  so  on.  This  method  will  not  work  on  parts  whose  uncertainty  is 
relatively  large  compared  to  the  clearances  through  which  the  parts  must 
be  pushed  or  moved,  because  merely  knowing  where  the  parts  are  at  some 
convenient  reference  points  will  not  guarantee  that  the  crucial  mating 
sections  will  be  in  the  correct  relative  positions. 

Although  this  argument  divides  items  assemblable  by  fixed 
automation  from  those  which  are  not,  it  does  not  mean  that  gearbox-like 
items  must  be  assembled  by  fixed  automation.  But  if  one  can  bring  the 
parts  of  the  gearbox  to  within  1 mm  of  certainty,  then  it  may  be  relatively 
easy  to  bring  them  to  within  0.  1 mm  and  use  a spring- loaded  jig  to  remove 
the  rest  of  the  uncertainty.  (0.  02  mm  is  really  necessary)  Most  fixer? 
automation  machines  attempt  the  entire  uncertainty  reduction  to  the  0.  U2  mm 
level  by  rigid  structures.  Anything  less  rigid  and  precise  may  not  stand 
up  in  industrial  environments.  Somewhat  less  precision  might  reduce 
design  and  setup  costs  of  such  machines,  as  well  as  maintenance  and 
adjustments  during  operation. 
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Research  sponsored  by  NSF  is  pursuing  the  above  issues  as  they 
pertain  to  assembly  system  architecture.  For  our  purposes  here,  these 
issues  strongly  influence  arm  design  because  they  illustrate  different 
scenarios  by  which  assembly  could  be  accomplished.  Some  combination 
of  arms,  feeders,  sensors  and  control  algorithms  must  be  used  to  reduce 
uncertainty  to  the  level  where  assembly  can  occur.  In  particular,  the 
"uncertainty  gap"  between  1.  0 mm  and  0.  1 mm  contains  most  of  the 
significant  uncertainties  in  parts,  feeders  and  arm. 


Part  uncertainties  are  determined  mostly  by  their  function:  items 
like  engines,  shafts,  gearboxes  and  so  on,  which  transmit  large  amounts 
of  mechanical  power,  are  carefully  machined  to  small  clearances,  small 
tolerances,  good  surface  finish  and  small  uncertainties  in  key  internal 
dimensions  within  each  part.  Plastic  parts  usually  have  good  surface 
finishes  but  may  bulge  or  shrink  alter  being  molded.  Stamped  metal  pieces 
may  become  bent  in  handling.  There  latter  two  types  of  part  will  function 


well  in  their  bent  or  bulged  condition  if  the  deformation  is  not  too  large. 
But  assembly  will  be  hampered. 


Feeder  uncertainties  are  mostly  a function  of  the  degree  of  feeding 
accuracy  needed  by  the  assembly  system.  The  cost  of  part  feeding  rises 

rapidly  as  part  size  increases  and  as  more  uncertainty  removal  is  demanded 
of  the  feeder. 


Arm  uncertainties  are  governed  by  technological  limitations  on 
structure,  sensors,  control  algorithms,  design  techniques,  physical  size 
of  the  arm,  and  the  amount  of  money  available.  There  is  a tradeoff 
between  arm  size  and  feeder  size,  both  governed  by  part  size.  Minimal 
investment  in  feeders  will  require  large  arms  merely  to  reach  for  the  parts 
A strong  arm  capable  of  rapidly  moving  heavy  parts  (i0  Kg)  will  be  large 
simply  to  support  itself  and  its  actuators.  Large  investment  in  feeders 
will  increase  the  degree  of  fixed  automation  associated  with  what  is 
supposed  to  be  flexible  automation.  Furthermore,  automatic  assembly  of 
large  numbers  of  small  parts  of  low  uncertainty  is  common  practice. 

Thus,  a major  research  problem  is  how  to  design  an  arm  to  transport 
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large  items  of  medium  uncertainty  from  medium  uncertainty  feeders  to 
receiving  parts  of  similar  uncertainty  and  successfully  assemble  them. 

It  is  clear  that  multiple  sensor  systems  integrated  into  the  servo  and 
strategy  control  systems  of  the  arm  will  be  needed  to  bridge  the  uncertainty 
gaps.  This  in  turn  requires  the  following  kinds  of  tools  for  a scientific 
approach  to  arm  design: 

• kinematic  synthesis  to  generate  candidate 
arm  configurations 

• methods  of  obtaining  geometric  and  dynamic 
equations  of  motion  for  use  in  speed,  mass 
and  actuator  studies 

• servo  control  techniques  for  obtaining  fast, 
smooth  motion  and  utilization  of  sensor  data 
in  a tight  closed  loop 

• structural  analysis  methods  for  studying  low 
weight  high  speed  designs  and  their  vibra- 
tion modes 

• error  analysis  techniques  for  predicting 

arm  uncertainties  from  component  inaccuracies 

C.  Major  Design  - Control  Issues 

Four  main  questions  thus  dominate  design  of  a mechanical 

arm: 

What  is  the  arm  going  to  do? 

How  shall  it  be  built  ? 

How  shall  it  be  controlled? 

How  shall  it  utilize  sensory  data? 
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The  first  concerns  task  specifications  like  reach,  speed,  and 
payload.  The  second  concerns  structure  and  actuators.  The  third  involves 
both  simple  stabilization,  vibration  supression,  and  general  strategy  of 
operation  for  high  efficiency  and  accuracy  with  low  over-shoot  and  power 
consumption.  The  fourth  concerns  feedback  sensors  in  the  hand,  joints 
and  elsewhere. 

A comparison  of  current  industrial  robots  and  the  people  they 
augment  or  replace  yields  some  insights.  A typical  step  in  the  manual 
assembly  of  a washing  machine  gearcase  reads  "Obtain  pinion  and  assemble 
to  gearcase.  That  is,  fetch  some  object  and  do  something  with  it.  More 
concretely,  a gross  motion  (much  larger  than  the  pinion  itself)  followed  by 
some  fine  motions  (usually  much  smaller  than  the  pinion  or  whatever). 

Most  industrial  robots  are  incapable  of  fine  motions  because  they  were 
designed  for  gross  motions  and  because  fine  motions  require  sensory 

feedb-ck  from  the  task  of  a kind  which  no  current  industrial  robots  have 
access  to. 

An  important  measure  for  both  human  and  robot  arms  is  the  ratio 
of  gross  motion  time  to  fine  motion  time.  A high  ratio  may  indicate  wasted 
time  in  mere  parts  feeding  activities  which  crowds  the  time  needed  for  the 
careful  work  of  assembly.  But,  for  people,  the  gross  motion  time  is  fairly 
consistently  lower-bounded  for  a given  task.  Overall  task  time  is  usually 
shortened  by  strategies  which  group  many  gross  motions,  such  as  carrying 
several  little  parts  simultaneously,  and  take  advantage  of  the  human  hand's 
dexterity.  One  can  hope  to  build  a robot  arm  strong  enough  to  exceed  a 
human's  gross  motion  speed.  Some  of  the  problems  of  doing  so  are 
discussed  below. 

Exceeding  a human's  fine  motion  speed,  which  includes  measure- 
ment and  strategy  - invocation  time  along  with  mere  speed  of  motion,  is 
much  more  difficult.  The  human  equipment  actually  consists  of  two  devices, 
an  arm  of  5 degrees  of  freedom  which  positions  the  hand  and  wrist,  plus 
the  hand,  a fine  motion  device  with  several  dozen  degrees  of  freedom  and 
many  sensors.  One  can  gain  some  design  freedom  in  a robot  fine  motion 
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device  by  separating  it  from  the  gross  motion  device  but  this  still  leaves 
the  robot  at  a disadvantage.  C urrent  technology  and  understanding  of  the 
problem  indicate  that 


1.  robot  gross  motion  must  be  very 
fast  to  gain  time  for  fine  motion  to 
occur,  or  else  strategies  like 
multipart  handling  must  be  adopted 

2.  robot  fine  motion  must  be  specialized 
and  carefully  designed  with  limited 
degrees  of  freedom  and  other  simplifi- 
cations 

3.  contradictions  could  arise  in  attempt- 
ing to  build  an  arm  which  simultaneously 
is  intended  to  perform  both  gross  and 
fine  motions  economically,  especially 

if  the  arm  is  physically  large 

A relation  between  structure  and  servo  occurs  in  design  of 
industrial  arms  where  unwanted  interactions  between  servo  and  structural 
natural  frequencies  could  occur  or  an  attempt  to  avoid  these  interactions 
could  result  in  a structurally  overdesigned  arm.  Some  examples  below 
discuss  these  points. 

Questions  Related  to  Gross  Motion  Patterns 


1.  how  large  is  the  arm  to  be  and  what 
kinematic  articulations  should  it  have 

2.  how  fast  should  it  be  able  to  make  a 
gross  motion  of  some  meaningful  size 

3.  what  range  of  inertial  and  gravitational 
loads  must  it  be  able  to  carry  at  the 
above  speeds. 
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Remarks:  It  is  generally  true  that  the  more  specialized  or 
dedicated  an  arm  is.  the  fewer  degrees  of  freedom  it  needs,  the  minimum 
being  one.  Programmable  robots  presumably  must  be  capable  of  a variety 
of  tasks,  especially  if  an  economical  number  of  them  is  to  be  manufactured. 
Beyond  this,  choice  of  task  for  design  purposes  is  difficult.  The  major 
variables  seem  to  be  payload  weight  and  distance  to  be  moved.  For  assembly 
of  a small  gasoline  engine  the  distances  are  all  small  but  a factor  of  100 
or  more  separates  the  weight  of  the  lightest  and  heaviest  parts.  For  an 
auto  instrument  panel  distances  are  large  but  all  the  parts  are  in  a small 
size  and  weight  range.  Large  and  heavy  parts  pose  the  biggest  challenge, 

especially  because  conventional  fixed  automation  machinery  cannot  handle 
them. 


For  tasks  of  a given  class,  a kinematic  analysis  can  be  performed 
to  minimize  the  size  of  a given  linkage  that  will  reach  a specified  set  of 
endpoints.  It  is  necessary  that  the  arm  not  be  fully  outstretched  at  such 
points  so  that  fine  motions  can  occur.  See  Section  IV  B. 

The  time  quoted  in  item  2 must  include  time  for  the  arm  to 
settle  down  on  the  target  point.  Settling  oscillations  and  overshoot  can 
result  from  the  structure  or  the  servo.  Settling  time  can  be  approximately 
related  to  servo  bandwidth  (for  a rigid  arm).  For  example,  if  stop  to  stop 
motion  time  is  to  be  one  second  and  settling  time  is  budgeted  10%  of  that 
time,  then  for  an  effective  damping  ratio  of  0.  5,  the  servo  with  arm  and 
load  must  be  flat  to  about  13  hz,  a very  difficult  goal  to  meet  with  a large 
arm.  Backlash,  if  present,  can  be  mitigated  by  moving  the  arm  very 
slowly  at  the  end  of  a gross  motion.  This  strategy  makes  efforts  toward 
high  servo  bandwidth  somewhat  superfluous. 

Items  1,  2.  and  3 determine  to  a large  degree  the  actuator  torque 
requirements  and  the  servo  bandwidth  needed  to  throw  around  the  arm  and 
load.  The  capabilities  of  the  actuators  need  to  be  balanced  (see  Section  IV  A) 
so  that  no  joint  is  over  or  under  designed  with  respect  to  the  others.  A 

number  of  industrial  robots  seem  to  have  weak  wrists  in  relation  to  their 
elbows  and  shoulders. 
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A 


Actuator  Type  and  Location 


4.  for  the  torque  requirements  from  above, 
what  type  of  actuator  should  be  used 

5.  what  sort  of  transmission  should  couple 
the  actuators  to  the  arm 

6.  how  much  accuracy  should  the  arm  have 

7.  how  much  resolution  should  it  have 


Remarks:  Families  of  actuators  can  empirically  be  described 
rather  accurately,  relating  their  peak  torque  or  rotor  inertia  to  their 
total  weight.  For  a family  of  DC  torque  motors  all  operating  at  the  same 
supply  voltage,  relation  is 


mass  in  kg  = 2.  1 x (torque  in  nt-m)0*875 

while  for  a family  of  hydraulic  rotary  vane  actuators,  all  operating  at  the 
same  supply  pressure,  the  relation  is 

kg  = 0.235  x (torque)0'55 

Comparison  of  these  relations  indicates  that  for  these  torque  motors  to 
compete  on  a torque  to  mass  basis  with  these  vane  actuators,  gears  of 
ratio  at  least  10  or  15  to  one  will  be  necessary.  Even  with  vane  actuators, 
the  weight  of  a hydraulically  driven  arm  is  mostly  actuator  weight.  One 
can  locate  the  actuators  in  the  arm's  base  and  transmit  power  through  shafts, 
cables,  tapes  or  chains,  which  will  save  weight  but  introduce  compliance. 
Gears  contribute  both  compliance  and  backlash,  which  decreases  accuracy, 
resolution  and  servo  stability.  Hydraulic  actuators  directly  coupled  to  the 
joints  develop  high  torque  but  compliance  appears  in  the  fluid,  an  effect 
which  can  be  reduced  by  careful  design  of  the  control  system.  Large 
hydraulically  driven  arms  with  fast  gross  motion  requirements  will  need 
large  servo  valves  which  in  turn  have  low  enough  bandwidth  to  affect 
settling  tim  and  the  speed  of  fine  motions. 


Thus,  the  issue  of  actuators,  their  type  and  location  on  the  arm 
is  a complex  one  affecting  all  aspects  of  design  and  control.  It  is  not  clear 
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whether  here  is  one  clear  cut  solution  suitable  for  all  situations. 
Technical  aspects  of  this  are  discussed  in  Section  1V-A.  Note  that 
although  miniature  hydraulic  actuators  are  noi  commercially  available, 
there  does  not  seem  to  be  any  reason  in  principle  why  they  should  not 
be  applicable  to  mini-robots.  Whet  ier  they  are  the  right  choice  is  an 
open  question. 

Fine  Motion  Patterns 

8.  how  small  must  the  fine  motions  be 

9.  how  rapidly  must  they  be  performed 

10.  what  and  how  many  arm  degrees  of 
freedom  must  be  involved 

Remarks:  Resolution  of  the  joint  sensors,  size  of  the  arm, 
backlash  in  gears  and  friction  in  the  actuatois  or  joints  all  can  limit  the 
fineness.  If  a rotary  actuator  far  from  the  hand  must  contribute  to  the 
fine  motion,  then  the  radius  from  the  joint  to  the  hand  times  the  joint 
sensor  resolution  indicates  but  does  not  absolutely  limit  the  fineness. 

(Some  types  of  actuators  can  be  jogged  open  loop  with  predictable  results.  ) 

The  rapidity  of  fine  motions  is  an  issue  for  industrial  arms 
equipped  with  touch  or  force  feedback.  References  2 and  3 describe  a 
force  vector  measuring  system,  located  in  the  wrist,  capable  of  resolving 
three  components  of  force  and  three  of  torque  about  a chosen  point.  Such 
a system  can  be  used  to  assemble  objects  in  much  the  same  way  people  do, 
by  making  some  small  deliberate  collisions  occur  and  judging  from  the 
direction  of  the  resulting  contact  force  how  to  move  next.  To  avoid  large 
contact  forces,  the  appropriate  change  in  the  arm’s  trajectory  must  be 
made  quickly.  A way  of  accomplishing  this  is  to  interpret  the  force  vector 
as  a servo  command.  However,  contact  forces  build  to  large  values 
quickly  if  arm  inertia  is  large  and  the  objects  and  their  supports,  including 
the  arm  itself,  are  stiff.  Technical  aspects  of  this  are  discussed  in 
Section  III-D  and  1V-D. 

Any  type  of  low  pass  cutoff  will  make  rapid  fine  motions 
difficult.  For  hydraulics  the  crucial  items  are  the  servo  valve  and  the 
compliance  represented  by  the  fluid  within  the  actuator.  Sizing  the  arm 
and  valves  for  rapid  gross  motions  and  heavy  loads  will  yield  large  slow 
valves  and  large  fluid  compliances,  inconsistent  with  rapid  fine  motions. 
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Computation  time  lags  and  filtering  time  associated  some  types  of  high 
accuracy  joint  sensors  also  add  to  this  problem. 

Structural  Members 

11.  for  the  given  kinematic  configuration, 
how  strong  or  thick  should  the  structural 
members  be 

12.  should  the  members  be  sized  for  static 
stiffness  (an  issue  related  to  accuracy 
in  a gravity  environment)  or  dynamic 
stiffness  in  conjunction  with  the  arm's 
masses  (related  to  structural  vibration 
and  its  interaction  with  the  servos) 

Remarks:  The  links  must  not  only  support  their  own  weight  and 
that  of  the  actuators  and  payload,  but  should  not  create,  in  concert  with 
these  masses,  structural  natural  frequencies  close  to  those  of  the  servo 
because  this  will  make  gross  and  fine  motions  difficult  to  accomplish 
quickly  and  could  prevent  using  the  servo  to  damp  out  structural  vibrations. 
These  issues  are  discussed  in  some  detail  in  Section  IV  C. 

Design  Evaluation 

Some  competing  criteria  are: 

13.  how  closely  does  the  arm  meet  the 
speed,  reach,  strength  and  accuracy 
requirements  originally  posed 

14.  how  efficiently,  in  terms  of  arm  weight 
and  power  consumption,  are  these 
requirements  met 

Remarks:  For  industrial  arms,  the  idea  of  load  factor  efficiency 
criterion  for  item  14  makes  sense,  where  load  factor  means  the  ratio  of 
dynamic  payload,  (usually  less  than  mere  lifting  capacity  since  an  economic 
time  to  move  the  payload  is  usually  enforced)  to  the  weight  of  the  movable 
parts  of  the  arm  itself.  Experience  indicates  that  a load  factor  of  5%  to 
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10%  may  be  typical  and  that  20%  would  be  quite  an  improvement.  Substitu- 
tion of  control  techniques  for  structural  weight  as  a vibration  supression 
method  could  allow  increases  in  load  factor. 

An  allied  efficiency  criterion  is  energy  consumption.  Typical 
large  industrial  manipulators  use  10  to  30  horsepower.  It  seems  reasonable 
to  compare  this  to  a "payload  power"  such  as  (payload)  x (reach)/(slew  time). 

D*  Accommodation  as  a Possible  Servo-Sensor  Control  Stragegy 

Accommodation  is  a basic  servo-sensor  strategy  for  making  an 
arm  modify  its  fine  motions.  Detailed  explanations  are  contained  in 
references  \ 1 ) and  ( 2 ).  The  basic  idea  is  that  the  arm  or  a device  on  the 
end  of  the  arm  or  work  surface  will  move  slightly  in  response  to  forces 
exerted  on  it  as  manipulative  actions  occur.  We  may  distinguish  two  basic 
types  of  accommodation:  passive  and  active.  Passive  accommodation  is 
accomplished  by  mounting  the  work  in  a spring-loaded  slide  or  other  base. 
Active  accommodation  is  accomplished  by  putting  a force  sensor  on  the 
arm  or  work  surface  and  involving  this  sensor  initimately  in  the  servo 
control  loops  of  the  arm.  Both  kinds  of  accommodation  are  intended  to 
allow  small  errors  of  placement  or  gripping  of  parts,  or  small  errors  in 
positioning  the  arrn,  without  the  intended  actions  of  the  arm  being  impaired 
or  halted. 

Passive  accommodation  seems  best  suited  to  very  small  errors  and 
when  "getting  out  of  the  way"  is  the  appropriate  strategy  for  assembling  two 
items.  For  this  to  be  successful,  the  force  levels  needed  to  push  the  arm 
or  part  into  position  must  not  damage  the  part.  The  forces  can  be  taken  up 
by  guides  on  the  base  which  holds  the  parts.  This  will  involve  a lot  of  guides 
plus  the  necessity  of  accurately  jigging  the  part  to  the  base  aud  guide.  The 
forces  involved  may  not  be  too  high  if  there  is  some  backlash  in  the  arm, 
but  backlash  involves  problems  of  its  own. 

Active  accommodation  is  a more  general  solution  to  the  error 
problem  because  other  strategies  besides  getting  out  of  the  way  can  be 
used.  The  extra  jigs  and  guides  are  eliminated,  and  less  accurate  initial 
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jigging  can  be  tolerated.  Larger  errors  can  be  tolerated  without  excessive 
force  buildup  because  the  force  sensor  informs  the  servo  how  to  move  the 
arm  to  reduce  the  forces.  Reference  ( 1 ) shows  how  active  accommodation 
can  accomplish  tasks  such  as  edge  following,  putting  pegs  in  holes,  placing 
holes  over  studs,  packing  items  into  corners,  and  so  on. 

Active  accommodation  acts  by  generating  velocity  :ommands 
which  are  superimposed  on  the  gross  motion  commands.  This  will  cause 
the  arm  to  keep  moving  until  all  forces  exactly  reach  their  desired  levels, 
which  can  be  controlled  by  the  gross  motion  commands.  The  dynamic 
characteristics  of  the  arm's  response  are  determined  by  the  magnitude  of 
velocity  command  generated  per  unit  of  force  sensed.  These  forces  are, 
of  course,  generated  by  the  arm's  motion,  so  the  force  feedback  loop 
comprises  an  extra  element  in  the  arm's  servo  and  must  be  designed  with 
care.  This  will  be  discussed  in  some  detail  in  the  next  section.  Briefly, 
the  issues  are  these: 

• servo  stability  when  the  arm  is  in  contact 
with  an  object  is  radically  different  than 
when  it  is  not  in  contact  --  the  servo  must 
be  designed  accordingly 

• the  physical  stiffness  of  the  coupling  between 
the  arm  and  its  environment  influences 
stability  --a  compliant  coupling  is  the  most 
benign  --  since  force  sensors  generally  are 
instrumented  compliant  systems,  the  physical 
stiffness  of  the  sensor  affects  not  only  its 
sensitivity  but  also  the  dynamic  behavior  of 
the  arm 

• the  arm  must  respond  rapidly  to  force- 
generated commands,  so  that  any  phase  lags, 
caused  by  servos  or  computation,  must  be 
kept  small 
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• this  rapid,  continuous  response  should 
be  distinguished  from  binary  or  threshold 
force  tests,  which  may  also  be  made  by 
an  accommodation  loop  --  binary  tests 
usually  involve  stop  and  go  motions  of  the 
arm,  which  are  inherently  slow  but  require 
less  of  the*  servo 

• backlash  which  occurs  between  the  actuator 
and  the  load  mav  be  tolerable  if  good  force 
sensor  readings  are  available  --  a lot  depends 
on  how  much  friction  there  is  in  the  arm  and 
how  the  servo  is  designed. 

Kef  ( 4 ) discusses  freeing  some  of  an  arm's  joints  as  a technique 
for  achieving  a kind  of  accommodation.  This  is  suitable  for  direct  electric 
drives  where  true  "freeing"  can  be  obtained,  but  poses  problems  of  friction 
in  gear  drives  and  the  need  for  extra  valving  to  free  hydraulic  drives.  More 
basic,  one  cannot  "free"  an  arbitrary  axis  relevant  to  a task,  but  rather  one 
must  free  a joint  of  the  arm.  This  lack  of  generality  severely  limits  the 
usefulness  of  this  strategy,  since  often  no  suitably  orientod  arm  axis  exists. 
Active  accommodation  overcomes  this  by  finding  the  right  combination  of 
axes  to  move  slightly.  The  desired  effect  of  freeing  occurs  but  no  axis  is 
actually  free. 


E.  Summary 

This  section  posed  the  assembly  problem  as  one  of  uncertainty 
reduction,  and  qualitatively  discussed  the  factors  influencing  assembly 
arms.  The  next  section  will  go  into  technical  detail  on  these  points  and 
demonstrate  the  design  tools  needed  to  specify  an  arm  which  will  perform 
assembly  at  a given  level  of  accuracy,  speed,  strength  and  reliability. 
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IV.  TECHNICAL  ASPECTS  OF  DESIGN  METHODS: 

SCIENTIFIC  APPROACH  TO  AnV.  DESIGN 


TOOLS  FOR  A 


This  section  goes  into  detail  on  the  technical  aspects  of  arm 
design  and  illustrates  the  use  of  a number  of  analytical  and  computer 
simulation  tools  to  aid  this  process,  drawing  on  the  results  of  several 
parallel  research  projects. 

A.  Gross  Motion  Size,  Payload  and  Speed 
1.  Task  Influences 


The  task  or  range  of  tasks  determine  the  demands  placed  on 
an  arm.  Its  size  is  determined  by  the  size  of  objects  on  which  it  works 
and  by  how  far  it  must  reach  for  parts.  The  size  of  the  work  area  it  must 
cover  may  be  influenced  by  hew  many  such  objects  it  must  work  on 
simultaneously,  with  two  to  four  being  a good  possibility  because  of  the 
time  saved  in  tool  changing. 


Size  strongly  influences  actuator  requirements  since,  for  a 
given  mass  and  angular  acceleration,  the  required  torque  depends  on  arm 
length  squared.  The  weight  of  parts  to  be  carried  plus  the  live  weight  of 
the  arm  determine  the  mass  which  the  actuators  must  accelerate  and  support 
against  gravity.  If  the  actuators  are  at  the  joints  (the  low  compliance  design 
choice)  then  the  weight  of  the  arm  may  be  largely  actuator  weight.  Thus, 
there  is  great  pressure  for  actuators  which,  though  light  in  weight,  deliver 
a lot  of  torque.  The  actuation  problem  is  discussed  below. 


The  required  accelerations  depend  on  the  size  of  the  motions 
and  the  speed  with  which  they  must  be  accomplished.  Station  times  on  manual 
assembly  lines  range  from  15  seconds  to  one  minute  and  usually  consist  of 
several  tasks.  Most  of  the  time  on  many  automobile  assembly  stations 
is  taken  up  by  gross  motions  in  the  form  of  carrying  parts  to  the  assembly 
point.  On  appliance  lines,  a station  time  of  15  seconds  may  include  three 
or  four  small  tasks  where  the  person  reaches  no  more  than  about  20  inches 
(51  cm)  to  obtain  parts  which  weigh  less  than  three  pounds  (1.4  kg).  The 


* Portions  of  this  part  were  supported  by  NSF  Grant  No.  GI-39432X. 
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heaviest  parts  weigh  over  20  pounds  (9  kg)  and  their  size  dictates  moving 
them  several  feet. 

These  requirements  combine  to  make  a difficult  design 
problem,  even  to  produce  a high  performance  gross  motion  device,  it  is 
debatable  whether  this  device  should  also  be  capable  of  fine  motions.  The 
issues  are  these:  General  gross  motion  devices  and  fine  motions  devices 
both  need  six  degrees  of  freedom,  the  difference  being  the  size  of  motions. 

A fine  motion  device  will  not  be  as  massive  as  a gross  motion  device  which 
supports  the  same  payload  since  it  probably  will  not  have  to  support  its 
actuators.  These  actuators  will  be  designed  for  limited  motion  range  and 
hence  can  be  lighter  for  the  same  torque  output.  Mi  ch  less  torque  is 
required  to  produce  small  angular  motions  than  large  ones  of  the  same 
angular  acceleration.  Motion  sensors  can  be  located  closer  to  the  work 
in  a fine  motion  device  (see  Error  Analysis  below),  allowing  more  accurate 
motions.  Some  of  these  advantages  of  a separate  fine  motion  device  are 
offset  by  the  need  then  for  two  motion  devices.  Furthermore,  the  gross 
motion  device  will  have  most  of  the  attributes  needed  for  fine  motion, 
including  low  friction  and  backlash  as  well  as  accurate  angle  sensors.  These 
are  needed  so  that  the  arm  can  position  the  part  properly  and  participate  in 
the  motions  even  if  the  fine  motions  are  performed  by  another  device. 


2.  Technology  Influences 

a.  Introduction 

Available  technology  places  limits  on  the  ability  of  a 
piece  of  real  hardware  to  perform  certain  tasks.  Obvious  limitations 
include  the  fact  that  the  actuators  required  to  move  the  manipulator  are 
limited  in  their  ability  to  exert  force  or  torque,  thereby  limiting  the 
loads  and  accelerations  that  can  be  handled.  Other  factors,  such  as 
friction,  quality  of  workmanship,  and  number  of  bits  of  position  sensing 
will  influence  the  accuracy,  repeatability  and  resolution  of  the  resulting 
equipment.  These  qualities  determine  the  fineness  of  work  that  the  arm 
is  capable  of  doing  as  well  as  influencing  the  quality  of  the  resulting  servo 
control  system. 

In  practice  we  must  design  by  choosing  between  alternatives, 
each  with  its  own  set  of  technological  limitations.  For  example,  in  the 
following  discussion  it  will  be  shown  that  hydraulic  actuators  possess  a 
different  set  of  technological  limitations  than  electric  actuators.  To  make 
an  intelligent  decision,  we  must  understand  the  consequences  of  the  sets 
of  limitations  of  the  technological  alternatives. 

b.  Influences  of  Choice  of  Actuators 

Once  an  arm  configuration  has  been  chosen  the  require- 
ments for  actuators  for  moving  the  manipulator  arm  can  begin  to  be 
specified.  First,  it  is  necessary  to  specify  the  torque  requirements  for 
each  of  the  actuators.  This  torque  requirement  is  influenced  by  each  of 
the  following: 

• Arm  mass  and  dimension 

• Actuator  masses  and  location 

• Desired  gross  motion  trajectory  (task) 

• Payload  mass 

• Required  gross  motion  task  completion  time 
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The  desired  gross  motion  trajectory,  or  task,  and  the  required  task 
completion  time  establish  the  accelerations  necessary  for  completion. 

These  required  accelerations  plus  the  net  inertia  of  the  manipulator, 
actuators,  and  payload  determine  the  torque  required  of  the  actuators. 

The  less  the  alloted  task  completion  time,  the  greater  the  required 
accelerations  and  so  the  greater  the  required  torques.  It  is  also  clear 
that  the  greater  the  moment  of  inertia  of  the  mass  distribution  of  the 
arm,  the  greater  the  torques  required  for  the  same  trajectory. 

Besides  inertial  loading,  there  is  gravitational  loading. 

This  is  a function  of  the  gross  motion  trajectory  that  the  arm  must 
execute  since  each  point  in  the  trajectory  path  has  a corresponding  set 
of  gravitational  moments  generated  on  the  actuators.  Consequently, 
gravitational  loading  is  not  a function  of  the  speed  with  which  the  arm 
executes  the  trajectory.  The  total  loading  on  the  actuators  at  each  point 
of  the  trajectory  is  the  sum  of  the  inertial  and  gravitational  loadings. 

It  should  be  pointed  out  here  that  the  torques  spoken  of 
are  only  what  is  ideally  required  to  execute  the  task  in  open  loop  fashion. 

No  control  system  is  assumed.  A realistic  actuator  control  system  may 
overlay  the  ideal  torque  history  with  its  own  dynamic  effects,  but  these 
perturbations  should  be  small  if  the  control  system  is  properly  designed. 

The  effects  of  task  time  and  payload  can  be  displayed  in  a 
performance  curve  such  as  Figure  IV-  1 taken  from  reference  2. 

Specified  task  time  is  shown  as  the  abscissa  and  payload  is  the  ordinate. 

The  curves  represent  lines  of  constant  peak  torque  for  a specified  trajectory 
for  each  actuator  of  a given  arm  design.  (Specific  details  of  the  arm  and 
task  will  be  given  later.  ) 

The  curves  represent  a boundary  on  the  performance  of 
the  arm.  Points  below  the  net  curve  represent  task  time  and  payload  that 
are  possible  for  the  arm  to  execute.  Points  above  the  curve  represent 
points  beyond  the  ability  of  the  actuators  of  the  arm. 
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Notice  that  as  task  time  increases,  the  curves  become 
more  horizontal  as  the  influence  of  inertial  loading  diminishes  and  the 
gravitational  loading,  independent  of  speed,  predominates.  For  shorter 
task  times,  the  inertial  loading  effect  becomes  greater  until  the  entire 
torque  capacity  of  an  actuator  is  necessary  to  move  the  arm  and  actuator 
mass  without  payload.  This  represents  the  lower  theoretical  limit  on 
task  time  for  the  manipulator. 

The  performance  curve  of  Figure  IV-  1 was  generated  with 
the  aid  of  a computer  simulation  program.  The  program  simulates  the 
dynamics  of  a three  joint,  three  link  arm  operating  in  a plane.  It  can  be 
used  to  simulate  the  approximate  dynamics  of  a six  degree  of  freedom 
manipulator  for  tasks  in  which  all  joints  and  links  remain  the  the  same 
plane. 

The  assumptions  used  for  generating  the  performance  curve 
of  Figure  IV-  1 were  that  the  manipulator  have  dimensions  and  mass 
distribution  equivalent  to  that  described  in  later  sections  of  this  report 
executing  a 90°  shoulder  sweep  from  straight  out  horizontal  to  straight 
down  vertical.  Figure  IV-  2 shows  the  simulated  manipulator  in  various 
stages  of  this  trajectory.  Also  indicated  are  the  masses  of  the  joints 
and  links.  Figure  IV-  3 shows  the  joint  torque  histories  for  the  trajectory 
shown  in  Figure  IV-  2 . Notice  that  prior  to  the  start  of  the  trajectory  at 
t = 0 each  actuator  is  exerting  torque  equivalent  to  the  gravitational  load- 
ing of  the  starting  configuration. 

A performance  curve  exists  for  each  actuator.  The  net 
performance  curve  consists  of  the  segments  of  the  individual  performance 
curves  that  are  limiting  over  their  particular  ranges  of  task  time.  For 
example,  in  Figure  IV-  1 it  is  seen  that  fox*  task  times  greater  than  one 
second  the  wrist  actuator  is  limiting,  but  for  task  times  from  . 6 to  1.0 
seconds  the  elbow  actuator  is  limiting,  while  for  task  times  for  . 5 to  . 6 
seconds  the  shoulder  and  elbow  actuators  are  almost  equally  limiting. 

This  is  the  result  of  an  attempt  to  obtain  a balanced  manipulator  design 
in  which  no  one  actuator  limits  performance  over  the  entire  range  of  task 
times.  Had  the  manipulator  actuators  been  designed  to  have  equal  payload 
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Figure  IV-3  Typical  Torque  History  for  Downswecp  Task  Trajectory 


rapacities  at  long  task  times  — for  essentially  pure  gravitation  loading  

then  the  payload  capacities  for  short  task  times  would  have  been  widely 
distributed  with  certain  actuators  very  overdesigned  and  others  under 
designed.  For  this  particular  manipulator  design  the  shoulder  would  have 
been  much  too  weak  and  the  wrist  much  too  strong  for  the  shorter  task 
times.  An  informal  survey  of  commercial  manipulators  indicates  that 
many  have  weak  wrists,  for  reasons  to  be  discussed  below. 

Obviously  two  important  components  of  the  total  inertial 
loading  are  the  actuator  masses  themselves  and  the  payload.  The  more 
massive  the  outboard  actuators  are,  the  more  torque  is  required  from  the 
inboard  actuators  to  move  them.  However,  more  torque  required  from 
an  actuator  generally  means  a more  massive  actuator. 

Figure  IV- 4 shows  maximum  torque  vs.  mass  for  families 
of  hydraulic  and  electric  actuators.  It  can  be  seen  that  torque  increases 
faster  than  mass  for  these  families  of  actuators.  Hence,  it  should  always 
be  possible  to  find  a set  of  actuators  with  sufficient  torque  to  move  a 
certain  payload  over  a trajectory  in  specified  time  by  choosing  sufficiently 
large  actuators,  up  to  reasonable  limits.  However,  the  less  mass 
required  of  a given  actuator,  the  less  the  torque  requirements  for  the 
actuators  inboard  of  it  and  so  the  less  massive  they  need  to  be  also. 
Consequently,  it  is  important  to  choose  actuators  with  as  high  a torque 
density  as  possible,  especially  for  the  outboard  (elbow  and  wrist)  actuators. 
Figure  IV-  4 shows  that  for  a wide  variety  of  hydraulic  and  electric 
actuators,  the  hydraulic  ones  are  about  an  order  of  magnitude  better  in 
torque  density  than  the  electric  ones.  This  means  that  arms  designed  for 
hydraulic  actuators  will  not  only  have  less  mass  but  also  will  require  less 
torque  to  move  the  arm  and  payload. 

c.  Gearing  on  Electric  Actuators 

The  low  torque  density  of  electric  actuators  can  be  increased 
by  adding  appropriate  gearing.  However,  the  gearing  presents  several 
problems  from  the  control  point  of  view. 

• Increased  weight  of  the  gears 
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• Backlash  between  actuator  and  load 

• Additional  compliance  in  drive  train 
as  the  meshing  teeth  deflect  under  load 

• Increased  apparent  inertia  of  the  actuator 

These  problems  degrade  the  ability  of  the  actuators  to 
perform  fine  motion  servoing  — a serious  drawback  for  an  assembly 
machine. 

Designers  of  commercial  arms  often  solve  the  problem 
of  heavy  outboard  actuators  by  utilizing  small  ones  or  little  if  any  gears. 
This  saves  load  on  the  inboard  actuators  but  results  in  a weak  wrist. 

d.  Influences  on  Accuracy,  Repeatability,  and  Resolution 

A discussion  of  the  influences  of  technology  on  accuracy, 
repeatability  and  resolution  of  a manipulator  requires  good  operational 
definitions  from  which  to  work. 

Accuracy  is  an  error  measure  representing  the  ability 
of  the  manipulator  to  achieve  an  arbitrarily  selected  position  in  space. 

The  operational  definition  is  as  follows: 

(1)  Choose  an  a priori  endpoint  position 
in  space  in  shoulder  coordinates. 

(2)  Compute  the  corresponding  set  of 
joint  angles. 

(3)  Command  the  arm  to  achieve  that  set 
of  joint  angles. 

(4)  Measure  the  error  between  the  actual 
endpoint  position  and  the  desired  end- 
point position  in  shoulder  coordinates. 

The  resulting  measured  error  represents  the  accuracy  of  the  manipulator 
system. 


42 


Repeatability  is  an  error  measure  representing  the 
consistency  of  operation  of  the  manipulator  system.  Its  operational 
definition  is  as  follows: 

(1)  Command  the  manipulator  to  execute  a 
particular  trajectory,  ending  with  a certain 
set  of  joint  angles. 

(2)  Measure  the  endpoint  position  in  shoulder 
coordinates. 

(3)  Command  the  manipulator  to  move  awa> 
and  then  repeat  the  same  trajectory  as 
above. 

(4)  Again  measure  the  endpoint  position  in 
shoulder  coordinates. 

(5)  Compute  the  error  between  the  first 
measurement  and  the  second. 

This  error  represents  the  repeatability  of  the  system.  It 
is  the  error  to  be  expected  between  identical  system  commands. 

Resolution  is  a measure  representing  the 
smallest  consistent  incremental  position  change  the  system  can  make. 
An  operational  definition  is  as  follows: 

(1)  Command  the  manipulator  to  execute  a 
particular  trajectory  ending  with  a certain 
set  of  joint  angles. 

(2)  Measure  the  endpoint  position  in  shoulder 
coordinates. 

(3)  Choose  an  incremental  direction  from  the 
endpoint  position  in  shoulder  coordinates 
and  command  a small  increment  in  position 
in  that  direction. 
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(4)  Measure  the  new  endpoint  position  in 
shoulder  coordinates. 

(5)  Compute  the  difference  between  the 
first  measurement  and  the  second. 

This  operation  is  repeated  several  times  to  determine  the 
smallest  consistent  incremental  position  change  of  the  actual  manipulator 
for  an  incremental  command.  The  smallest  actual  incremental  change 
is  the  resolution  of  the  system. 

Resolution  is  limited  by  things  such  as  nonlinear  frictional 
force  characteristics.  Typically,  before  a machine  with  moving  parts 
can  begin  to  move  from  a standstill,  a certain  breakaway  force  or  torque 
must  be  exerted  to  overcome  the  static  friction  between  the  parts.  After 
the  parts  begin  to  move,  they  must  still  face  a constant  running  friction 
which  is  usually  less  than  the  static  friction. 

Due  to  the  servo  compliance  between  the  desired 
manipulator  position  and  the  actual  manipulator  position  an  error  between 
the  actual  and  desired  positions  causes  the  servo  to  exert  a restoring 
force.  Hence,  there  is  a certain  incremental  command  error  required  to 
generate  the  breakaway  fo-ce  necessary  to  overcome  the  static  friction. 

Now  assume  that  a certain  command  error  existed  that  provided  enough 
actuator  force  to  just  overcome  the  static  friction.  Then  how  far  the  system 
travels  will  depend  upon  how  different  the  running  friction  is  from  the 
breakaway  friction.  If  the  running  friction  is  much  less  than  the  break- 
away friction,  then  the  system  may  move  a comparatively  large  increment 
before  the  running  friction  brings  it  to  a stop.  However,  if  the  running 
friction  is  only  a little  less  than  the  breakaway  friction,  than  the  resulting 
actual  position  increment  may  be  rather  small. 

Consequently,  it  can  be  seen  that  the  resulting  increments 
in  actual  manipulator  position,  which  correspond  to  the  resolution  of  the 
manipulator,  depend  on  nonlinear  frictional  characteristics  and  servo 
compliance  at  least.  Also,  it  is  clear  that  the  commanded  increment 
in  position  does  not  necessarily  equal  the  resulting  actual  motion.  In 
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fart,  it  usually  will  not.  Based  on  this  analysis,  the  resolution  of  a 
manipulator  may  be  improved  by  increasing  servo  stiffness  (decreasing 
serve  compliance),  by  reducing  friction  in  general,  and  by  making 
breakaway  friction  as  close  to  running  friction  as  possible. 

In  general,  backlash  will  not  affect  the  resolution  as  v.e 
have  defined  it.  However,  it  will  affect  the  command  errors  that  must  be 
given  to  generate  the  small  actual  increments.  In  particular,  if  a change 
of  direction  is  involved  in  executing  a particular  increment  of  position, 
the  length  of  the  backlash  will  have  to  be  added  to  the  required  command 
inc  rement. 

If  the  manipulator  control  system  is  based  on  commands 
issued  from  a digital  computer,  then  the  quantization  of  commands  may 
itself  determine  the  resolution  of  the  manipulator.  This  is  entirely 
dependent  on  the  design  of  the  control  system.  It  follows  that  a design 
criterion  for  the  control  system  would  be  not  to  limit  the  resolution  of 
the  device  unnecessarily. 

The  physical  processes  that  lead  to  repeatability  errors 
are  hard  to  find,  but  can  be  assumed  to  lie  in  variations  of  the  physical 
processes  themselves  and  surrounding  conditions.  Our  operational 
definition  of  repeatability  requires  that  the  test  point  be  approached  along 
the  same  trajectory.  This  was  done  to  insure  equal  processes;  for 
example,  that  all  backlash  elements  were  in  the  same  state  from  test  to 
test.  We  may  find  a different  repeatability  measure  if  this  condition  were 
relaxed  and  we  allowed  the  test  point  to  be  approached  from  arbitrary 
directions.  Not  only  backlash  but  also  other  factors,  such  as  friction, 
may  vary  with  trajectory  history,  leading  to  a larger  repeatability  figure. 

Accuracy  errors  involve  a larger  part  of  the  system  than 
do  resolution  and  repeatability.  Accuracy  measures  the  ability  of  the 
system  to  execute  a position  command  open  loop.  All  of  the  following 
will  contribute  to  errors  in  accuracy: 

(1)  Structural  deflections 

(2)  Servo  compliance 
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(3)  Position  sensor  error 

(4)  Backlash  in  drive  train  if  it  is  not  seen 
by  position  sensor 

Because  the  first  three  factors  tend  to  remain  constant  from  test  to  test, 
they  do  not  tend  to  contribute  to  errors  of  repeatability  and  resolution. 

But  just  because  they  tend  to  remain  constant  over  many  tests,  it  is 
theoretically  possible  to  compensate  for  these  errors  in  the  digital  computer 
at  the  cost  of  added  complexity. 

Backlash,  however,  may  not  produce  the  same  error  from 
test  to  test  especially  if  the  trajectories  leading  to  the  test  point  differ. 

This  may  result  in  the  backlash  being  in  a different  state  in  different  tests, 
contributing  to  errors  in  accuracy. 

Accuracy  is  an  irrelevant  concept  to  manipulation  systems 
that  arc  ’taught"  positions  by  manually  guiding  them  into  the  desired 
position  and  indicating  to  the  supervising  system  that  it  should  "remember" 
this  particular  point.  These  systems  are  simply  not  required  to  compute 
a desired  position,  only  to  repeat  motions  that  have  been  taught.  Hence, 
repeatability  and  resolution  are  the  only  appropriate  error  measures  for  their 
motions. 

Accuracy  is  clearly  important  to  the  gross  motion  of 
machines  that  must  compute  their  way.  This  will  be  the  case  if  they  are 
taught  their  tasks  by  symbolic  command  languages  which  make  reference 
to  items  and  places  in  shoulder  coordinates. or  if  they  use  visual  or  other 
information  which  is  obtained  in  coordinates  other  than  those  of  the  arm's 
joints.  Clearly  resolution  is  important  to  the  ability  of  the  manipulator  to 
execute  fine  motion  because  it  determines  how  fine  that  motion  can  be. 
Repeatability  is  important  to  both  gross  and  fine  motion  because  it  is  a 
a measure  of  how  consistent  and  reliable  those  motions  can  be. 
e.  Influences  on  Servo  Design 

The  purpose  of  the  servo  system  is  to  control  the  actuators 
to  produce  the  desired  response  in  the  manipulator  system.  Goals  of  the 
servo  design  are  to  produce  smooth,  stable  performance.  The  actual 
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motions  of  the  real  manipulator  hardware  must  have  good  fidelity  to  the 
ideal  motions  prescribed  by  the  computer. 

There  are  two  broad  influences  on  the  design  of  a servo 
system.  One  is  the  nature  of  the  input  commands  to  the  servo  system. 

If  the  manipulator  is  expected  to  accomplish  gross  motions  in  .5  sec,  then 
the  frequency  response,  or  bandwidth,  of  the  entire  controlled  system, 
including  payload,  certainly  ought  to  be  well  above  2 Hz  in  order  to 
reproduce  the  desired  motions.  Computer  simulations  have  been  used  to 
determine  that,  for  0.5  sec  task  completion  times,  5 Hz  control  bandwidth 
produces  adequate  performance,  but  that  10  Hz  control  bandwidth  produces 
very  good  performance  for  a variety  of  simulated  gross  motion  tasks  of 
the  arm  shown  in  Figure  IV-2. 

The  second  broad  influence  on  the  design  of  a servo  system 
is  the  frequency  response  of  the  components  of  the  system.  Each  component 
of  a system  has  its  own  dynamic  characteristics,  some  of  which  may  limit 
the  performance  of  the  overall  closed  loop  system.  For  example,  the  servo 
valve  controlling  the  hydraulic  actuator  cannot  open  and  close  instantaneously 
on  command.  Typically,  it  has  a frequency  response  bandwidth  of  about 
100  Hz.  The  resolvers  used  to  detect  angular  position  and  rate  (discussed 
in  section  VII)  are  read  by  a phase  locked  loop  which  will  probably  have  a 
bandwidth  of  between  60  and  100  Hz.  (Conventional  angle  readouts  have 
little  or  no  bandwidth  limitations  but  do  not  generate  rate  information. ) 

There  is  a possibility  that  components  such  as  these  with  similar  band- 
width can  interact  to  produce  system  instabilities  and  resonances.  The 
control  system  must  be  designed  to  prevent  this. 

Another  component  whose  frequency  response  is  important 
to  the  control  system  design  is  the  physical  manipulator  structure.  Work 
by  Book  (reference  5 ) and  Maizza  (reference  6 ) has  shown  that  the 
resonance  characteristics  of  the  arm  structure  are  intimately  related  to 
the  servo  bandwidth.  This  relationship  is  discussed  further  in  section 
IV-C. 
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B.  Kinematic  Configuration 

1.  Approach 

The  approach  to  determining  an  optimum  arm  design  with 
respect  to  its  geometrical  abilities  and  properties  is  basically  threefold: 
number,  type,  and  dimension.  The  number  of  freedoms  required  and 
their  disposition  will  first  be  analyzed.  Then  the  types  of  joints  needed 
to  realize  these  freedoms,  e.g.  revolute,  spherical,  cylindric,  etc. 

Finally,  dimensional  data  will  be  obtained  through  a generalized  synthesis 
procedure. 

The  und  ;rlying  guide  for  this  entire  process  is  with  respect  to 
the  tasks  at  hand;  thus,  the  configuration  issues  treated  here  bear 
primarily  on  the  size  and  dexterity  of  the  moving  elements  involved  in 
assembly  tasks.  These  elements  include: 

1.  part(s) 

2.  end  effectur(s ) 

3.  means  of  causing  relative  motion 
between  the  above 

The  size  of  the  parts  and  subassemblies  is  determined  by 
comparing  a range  of  tasks  in  which  a need  to  automate  is  clearly 
demonstrated,  but  where  manual  assembly  is  currently  employed.  Also, 
it  is  our  aim  to  select  a range  that  does  not  materially  imply  an  advance 
in  the  state-of-the-art  in  mechanical  design,  e.g.,  a microscopic  or 
gargantuan  assembly  environment. 

Since  modern  fixed  automation  techniques  have  shown  competence 
in  handling  subassemblies  of  up  to  about  10  cm  diameter  (spherical),  the 
range  chosen  for  our  tasks  was  between  half  and  one  order  of  magnitude 
greater,  viz.  30  cm  to  1 m.  Once  the  requirements  for  dexterity  are 
defined  and  met,  the  overall  size  and  geometry  of  the  mobility  subsystem 
can  be  matched  to  the  task. 
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2.  Disposition  of  Freedoms 

The  range  of  assembly  tasks  to  be  attacked  has  been  concep- 
tually limited  by  size,  weight,  etc.  but  not  with  respect  to  dexterity.  In 
general,  at  least  6 degrees  of  freedom  (dof)  are  required  to  orient  and 
place  a body  in  space,  these  freedoms  may  be  divided  between  two 
mobility  subsystems  for  binary  assembly  tasks  (those  that  involve  the 
interfacing  of  no  more  than  two  elements):  one  system  per  element. 
(Figure  IV -5) 

More  freedoms  could  aid  mobility  by: 

a.  increasing  range  of  motion 

b.  avoiding  singularities  of  motion 
that  occur  in  practical  mechanical 
design 

c.  allowing  redundant  positions  of  the 
members  for  the  same  end-point 
position 

There  is  a case  where  fewer  freedoms  wouid  be  helpful:  when 
fewer  than  six  dof  are  required,  extra  freedoms  could  add  position  errors 
and  compliance.  For  example,  an  assembly  task  requiring  only  the 
insertion  of  parts  from  one  direction  into  an  accurately  positioned  sub- 
assembly  might  require  less  than  completely  general  motion. 

Indeed,  a prime  consideration  of  this  effort  is  to  include 
mobility  to  accomplish  parts-fetching  and  jig-holding.  For  the  outset, 
however,  an  arm  that  embodies  both  gross  and  fine  motion  capabilities 
is  desirable.  Experiments  and  evaluation  of  both  modes  of  operation  can 
proceed  while  peripheral  devices  are  designed  and  constructed  for  the 
more  specific  chores. 

Moving  base  design,  i.e.,  a mobile  fixture  for  holding 
subassemblies,  is  currently  being  investigated.  A 3 dof  platform  design 
(Figure  IV-  6 ) featuring  x,  y,  and  0 motions  of  a limited  range  is  being 
optimized,  and  a 6 dof  platform  of  limited  range  has  been  suggested  for 
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use  in  high  speed  "accommodation"  t^dts.  (Figure  IV-7) 

Another  system  consideration  is  ’.he  ability  to  interface  with 
existing  assembly  lines.  This  may  severely  limit  the  dividing  up  of 

the  mobility  subsystem  freedoms.  Therefore  the  system  under  considera- 
tion embodies  all  six  dof  in  one  "arm."  Additional  freedoms  can  of 
course  be  added  later.  Recall  also  that  for  our  purposes  as  a laboratory 

tool,  this  system  should  feature  as  much  flexibility  of  operation  as 
possible. 

To  take  full  advantage  of  the  work  volume  afforded  by  the  chosen 
arm  configuration,  the  work  should  be  (conceptually  at  least)  at  the  center 
of  the  ranges  of  the  primary  position  axes.  Since  a consideration  of  the 
system  was  "current  assembly  line  techniques,  " the  range  of  position  of 
the  work  is  quite  limited.  For  an  object  resting  on  a table  (a  most 
common  occurance)  the  optimal  placement  of  a single  arm  would  be 
directly  above  it  as  shown  in  Figure  IV-8. 

An  obvious  additional  freedom  now  presents  itself:  vertical 
traverse,  to  vary  the  position  of  the  work  volume  vertically  above  the 
work.  This  freedom  is  present  in  the  laboratory  system  as  a series  of 
fixed  mounting  points  along  a vertical  column. 

Since  this  system  will  be  computer  controlled  some  attention 
must  be  paid  to  the  mathematical  tractibility  of  the  configuration.  The 
following  rules  might  be  observed  in  picking  an  arm  geometry.  These 
considerations  may  of  course  be  in  conflict  with  other  design  goals  and 
should  be  considered  to  be  of  secondary  importance. 

a.  Offsets  between  joints  should  be 
avoided. 

b.  Successive  axes  should  intersect  in 
angles  a multiple  of  w/2. 

c.  Adjacent  rotary  joint  axes  should 

be  parallel,  i.  e.,  planar  geometries 
are  preferred. 
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Figure  IV -8 

Arm  Mounting  and  Work  Volume 
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d.  Sliding  joints  are  preferred  over 
rotary. 

e.  Number  of  joints  should  be  minimized. 

3.  Types  of  Joints 

An  arm  may  be  divided  into  two  parts  of  3 dof  each:  position- 
ing and  orienting.  These  are  not  necessarily  independent  in  that  one 
could  cause  perturbations  in  the  other.  Clearly,  the  latter  requires 
rotational  motion,  whereas  the  former  can  be  implemented  with  a combina- 
tion of  either  rotational  or  telescoping  (linear)  motions. 

Four  different  configurations  for  the  positioning  degrees  of 
freedom  can  be  realized:  all  three  linear  degrees  of  freedom,  two 
linear  degrees  of  freedom  and  one  rotary  degree  of  freedom,  two  rotary 
degrees  of  freedom  and  one  linear  degree  of  freedom, or  all  three  rotary 
degrees  of  freedom.  These  are  shown  schematically  in  Figures  IV-9  and 
IV- 10.  The  different  configurations  have  different  advantages  and 
disadvantages.  The  all  linear  degree  of  freedom  configuration  is  best  for 
computational  purposes  as  the  wrist  point  can  be  specified  directly  in 
cartesian  coordinates.  It  is  probably  the  best  design  for  stiffness  but  is 
the  worst  design  for  volume  accessed  compared  to  the  volume  required 
for  the  structure.  It  would  also  be  difficult  to  use  two  such  arms  to  work 
on  one  assembly.  At  the  other  end  of  the  scale,  the  all  rotational  degree 
of  freedom  arm  has  the  best  ratio  of  volume  accessed  to  volume  of 
structure,  particularly  if  the  arm  is  hung  from  an  overhead  structure. 

This  configuration  has  an  additional  advantage  in  that  there  are  two 
solutions  for  having  the  wrist  point  at  a particular  point  in  space.  It  is, 
however,  the  worst  design  for  stiffness  and  for  computation. 

As  the  manipulator  was  to  be  used  to  perform  assembly 
experiments  and  it  was  desirable  that  it  be  able  to  inte-face  with 
existing  assembly  lines,  the  all  rotational  degree  of  freedom  configuration 
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was  chosen.  This  decision  was  largely  based  on  the  accessibility  that 
this  configuration  affords  with  a minimum  of  structure. 


The  orienting  set  of  freedoms  presents  another  pair  of 
candidate  designs  (Figure  IV-1 1 ).  The  only  functional  difference  between 
them  is  the  orientation  of  the  motion  singularity:  the  point  at  which 
you  can  t get  there  from  here.  " To  illustrate,  when  type  R-P-R  is  in  the 
straight  out  orientation,  the  roll  axes  coincide  thereby  reducing  the 
number  of  freedoms  by  1:  you  can  roll  and  pitch,  but  can't  yaw. 

Similarly,  when  either  joint  P or  Y in  the  R-P-Y  type  is  "bent  90°"  the 
roll  motion  (with  respect  to  the  end  effector)  is  impossible,  and  is 
extremely  difficult  within  15°  or  so  of  the  90°  position. 

The  RPY  design  was  adopted  since  the  loss  of  freedom  when 
bent  90  was  deemed  less  a problem  than  when  "straight  out.  " Until 
a truly  spherical  joint  is  devised  or  a 4th  freedom  added,  we'll  just 
have  to  live  with  the  singularity. 
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Figure  IV- 11 

Candidate  Wrist  Configurations 

; 
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4.  Optimization  of  Arm  Geometry 

A general  procedure  is  outlined  here  allowing  for  optimisation 

arm  geometry  to  a specified  task.  This  procedure  requires  machine 

computation  and  does  not  readily  lend  itself  to  hand  calculation  or  graphical 
techniques.  6 H Ldl 

Sliding-joint  geometries  were  not  considered  since  empirical 
data  are  easily  obtained  graphically. 

Figure  IV- 12  shows  a planar  all-revolute  arm  described  by 
unknown  lengths  x,,  x2  and  x... 

One  can  describe  a general  "task"  requiring  the  arm  to  touch 
n selected  points  in  the  workspace  with  specifi  o orientations.  (Inter 
ferences  are  not  considered,  bu,  may  be  added  with  algorithms  no,  treated 
ere. ) The  potnts  might  represent  one  or  more  objects,  tools,  etc., 
that  the  arm  will  be  required  to  interact  with. 

Figure  IV- 13  shows  such  a task  definition  with  the  arm  in 
position  j.  We  can  express  this  situation  like  so: 


10-  i®: 

-le  +-*2e  J 


+ *3e 


J = 


Z. 


IV- 1 


where  Xj  are  complex  (unknowns) 

r orientation  of  xg  in  position  j (given) 

Z.  = complex  location  of  point  j (given) 

9j  and  <0.  are  to  be  adjusted  by  iteration 

We  wish  to  optimize  for  the  given  task  and  require  (for 
example)  that  the  arm  be  as  short  as  possible: 


minlil+i2+23|  * I Sol 


IV- 2 
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The  n + 1 relations  may  be  written  out  like  so 


1 1 1 
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or,  equivalently: 

M )C  = Z . jy_4 

A root-mean-square  solution  of  (4)  for  x can  be  obtained  by 
introducing  the  complex  conjugate  of  M,  viz 

x = (M*  M)"1  KT*  Z . iv- 5 

For  non- trivial  solutions,  (ffl1  M)  will  be  invertabie. 

Convergence  error  can  be  given  by 

E.  = ■ Z.  IV- 6 

Minimization  of  |zq|  can  be  assumed  by  including  it  in  the 
error  parameter" 

C * K E 1 E + x 1 x IV- 7 

where  K weights  convergence  error  to  the  same  order  of  magnitude  as 
lz0|  = typically  1(T  or  10. 

The  optimization  procedure  is  now  reduced  to  the  adjustment  of 
the  2n  quantities  Q.  and  0..  This  will  be  accomplished,  with  a pattern- 
seat  ch  algorithm,  with  e as  the  objective  parameter. 
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Good  initial  estimates  may  be  obtained  graphically.  A 
computer  program  to  implement  the  above  procedure  has  been  written 
and  used.  Input  values  depicted  a single  planar  view  of  the  Briggs  and 
Stratton  3 Hp.  gasoline  engine. 

Nine  test  positions  (Zj  and  were  given.  The  arm  was 
considered  directly  above  the  work  at  a distance  y.  This  distance  entered 
the  solution  process  as  a patch  by  adding  y (real)  to  the  imaginary 
parts  of  . An  initially  large  estimate  for  y was  needed  to  avoid  solutions 
that  imply  the  interference  of  a vector  (arm  member)  thiough  the  implied 
task  boundary.  The  results  are  as  follows: 

Constraints:  "elbow"  angle  (0  - 0.)<  +2.355  rad  (135°) 

J J 

Variables:  0.  , , y 

J J 

Run  1 results: 

x3  forced  to  zero,  results  inconclusive 

Run  2: 

x3  constrained  = 8 in.  (20.  3 cm) 

Results: 

Xj  = 17.  9 in  (45.  4 cm) 

x2  - 17.  9 in 

y = 33.  8 in  (mounting  distance)  (85.  8 cm) 

Curiously  enough,  an  arm"  with  rather  anthropomorphic 
proportions  is  implied  by  the  procedure:  equal  lengths  of  "forearm"  and 
upperarm  . The  8 value  for  x3  was  picked  in  consideration  of  the 
mechanical  outlines  of  possible  end  effectors  and  other  tools. 

Other  tasks  of  a more  complex  nature  might  not  indicate  such 
proportions,  and  one  might  well  conjecture  whether  this  result  is  due  to 
a product  designed  with  human  assembly  in  mind. 

The  greater-than-human-size  indicated  by  the  procedure  is 
probably  due  to  the  immobility  of  the  "shoulder":  with  only  6 dof  allowed. 
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the  mobility  subsystem  can  have  "hands,  " but  no  "feet.  " 

1 he  final  dimensions  of  the  arm  reflect  the  values  obtained 
above  and  are  shown  in  Figure  V-l. 
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C.  Relation  Between  Servo  Bandwidth  and  Structural  Vibration 

Because  all  structures  are  flexible  and  because  pressure  to 
reduce  structural  weight  increases  the  structure's  flexibility,  one  must 
be  cautious  about  exciting  structural  vibrations  through  the  action  of 
the  control  servo.  If  the  arm  is  moved  slowly  enough  then  such  vibrations 
will  not  be  bothersome.  This  may,  however,  require  intolerably  slow 
motions. 

Flexibility  may  occur  in  structural  members  and  in  drive  trains 
(shafts,  gears,  bearings,  etc. ).  Gear  teeth  and  long  shafts  are  especially 
severe  sources  of  flexibility.  The  stiffness  of  a long  shaft  or  beam 
decreases  with  the  cube  of  its  length,  so  the  flexibility  problem  is  much 
worse  for  long  arms  than  for  short  ones.  Servo-induced  vibrations  can 
arise  either  during  fine  motions  or  during  the  startup  or  slowdown  phase 
of  controlled  gross  motions  in  places  where  trajectory  accuracy  is  important. 

Work  on  this  problem  has  been  conducted  on  the  assumption  that 

each  arm  joint  has  its  own  servo  control  which  acts  independently  on  sensor 

data  derived  from  that  joint  alone.  Two  simplified  models  have  been 

used,  a one-joint  arm  and  a two-joint  arm.  In  the  former,  the  joint  is  in 

the  middle  of  the  arm,  forming  a controlled  elbow,  while  the  shoulder  is 

locked.  In  the  latter  model,  the  shoulder  is  also  controlled.  Reference  (5) 

contains  detailed  studies.  In  each  model,  the  joint  servo  gains  are  chosen 

to  achieve  a natural  frequency  (undamped)  of  w . Damping  is  provided  by 

s 

velocity  feedback  and  provides  damping  ratio  £ relative  to  w . Both 

s 

w and  £ are  calculated  on  the  assumption  that  the  structural  members  are 

o 

rigid.  These  members  are  assumed  to  be  uniform  tubes  of  radius  r with 

wall  thickness  of  r/5.  With  the  joints  locked  solid  the  structure  will  exhibit 

a lowest  frequency  wp  of  structural  vibration.  A study  was  conducted  to 

determine  the  relationship  between  w and  w with  these  results: 

s c 


* Work  supported  in  part  by  NASA  MSFC  Contract  NAS8-28055. 
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• if  Wg  < wc/3,  the  Structure  appears 
to  be  essentially  rigid 

• lfwc/3<  wg  < wc/2,  some  structural 
vibration  occurs  but  is  well  damped 

• if  wg  > wc/2,  insufficient  damping  is 
available  and  structural  oscillations  will 
be  troublesome  or  even  destructive. 

Most  arms  seem  to  be  designed  conservatively,  with  w well 
below  wc/3.  This  causes  the  arm  to  be  heavier  than  it  needs  tote  for 
the  bandwidth  it  can  achieve.  The  extra  weight  penalizes  gross  motion 
times  (for  fixed  strength  actuators)  approximately  in  proportion  to  w . 
Joint  angle  resolvers  must  be  located  inboard  of  any  joint-related 
compliances,  or  else  servo  instability  will  occur  (ref.  7 ).  This  fact  is 
still  being  discovered  empirically  by  some  arm  designers. 

Additional  studies  have  been  performed  with  more  complex  servo 
control  schemes.  A rigid  arm  servo  design  technique  is  explained  in 
reference  ( 1 ).  consisting  of  providing  sensor  data  from  all  joints  to  the 
control  decision  at  each  joint.  The  same  w&  can  now  be  obtained  with 
lower  servo  gains,  especially  at  the  shoulder,  than  in  the  former  servo 
method.  The  main  result  with  respect  to  structural  vibration  is  that 
ws  ~ wc  or  more  can  be  achieved  with  good  performance.  No  commercia 
manipulator  operates  with  this  more  complex  servo.  It  would  seem 

however,  that  much  lighter  or  faster  arms  (for  the  same  actuatorsl’woul, 
thereby  be  possible.  (See  Ref.  6) 


In  addition  to  stiffness  considerations,  one  must  also  pay 
attention  to  strength.  We  find  that  for  many  arms,  stiffness  requirements 
exceed  strength  requirements  and  the  latter  are  automatically  satisified 
if  the  former  are.  This  is  lot  always  the  case,  as  reference  ( 5)  shows. 
For  the  record,  however,  it  should  be  clear  that  plastic  deformation  in 
an  industrial  arm  is  tantamount  to  a failure  and  must  be  avoided. 

One  may  utilize  the  torque-speed  studies  in  Section  IV.  A 2 to 
obtain  operating  torque  levels.  In  Section  VII.  B it  is  shown  that  an  arm 
of  adequate  stiffness  will  have  an  area  moment  of  5 in4  at  the  shoulder, 
where  a torque  of  500  ft-lb  may  be  encountered  during  gross  motions.  If 
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r ^ *hen  s*ress  outside  edge  of  the  structure  is  only 

3600  lb/in  , less  than  3%  of  the  yield  stress  for  ordinary  steel.  The 

bulk  of  the  analysis  in  Section  VII.  B therefore  deals  with  stiffness,  not 
strength. 


Servo  Control  Methods  and  Force  Feedback 

In  the  previous  part  of  this  section,  it  was  noted  that  servo  controls 
can  be  synthesized  to  utilize  information  from  all  joints  in  determining 
control  at  each  joint.  Besides  the  benefit  of  better  vibration  control,  other 
advantages  are  possible.  These  are  discussed  here. 


fn  reference  1 it  is  shown  that  the  dynamic  equations  of  motion 
of  a rigid  arm  can  be  put  in  the  form 
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where  0_  is  a vector  of  controllable  arm  degrees  of  freedom  (joints),  Q_ 
is  a vector  of  joint  velocities,  the  corresponding  accelerations,  I is 
the  inertia  matrix  and  r_  is  a vector  of  control  torques  applied  at  the  joints." 
This  model  is  linearized  but  experience  with  simulations  indicates  that 
the  nonlinear  Coriolis  terms  usually  account  for  less  than  10%  of  the 
torque  in  such  maneuvers  as  those  in  section  IV  . A.  2.  Reference  1 also 
shows  that  a control  of  the  form 

I - KT(e-ec)  + KTD(i"ic) 

can  be  used  to  cause  the  arm  to  follow  a commanded  trajectory  described 
by  0c  and  0c.  Interesting  choices  for  matrices  KT  and  KTD  will  not  only 
place  the  poles  of  the  overall  system  at  desired  places  but  will  cause  the 
system  to  have  characteristic  oscillation  modes  in  convenient  coordinates 
and  with  good  damping.  One  can,  for  example,  make  the  arm  behave  as 
a set  of  completely  independent  damped  second  order  systems  whose 
independent  axes  are  those  of  the  hand  coordinates  of  the  arm.  This  is 

* U is  an  identity  matrix. 
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important  in  the  design  of  accommodation  st.ategies  where  one  needs  to 
have  an  arm  which  wili  respond  dynamically  only  in  the  desired  direction 
as  indicated  by  force  feedback,  with  no  bothersome  dynamic  cross, a, k 
into  uncommanded  directions.  Reference  1 gives  a general  procedure  for 
accomp  is  ing  this  which  will  produce  the  correct  K and  K for  any 
configuration  of  a given  arm.  1 TD 

A basic  accommodation  loop  functions  by  converting  force  sensor 
eadings  into  setvo  commands  which  modify  « and  6 Generalised  force/ 
torque  vector  F is  measured  by  a sensor  on  the  arm  or  work  surface.  If 
he  sensor  is  on  the  arm  at  the  wrist.  F is  in  hand  coordinates. 

Accommodation  works  by  generating  velocity  modification  commands 
Kmff  in  hand  coordinate- 


-DM  = KF-L 

where  Kp  is  called  the  accommodation  matrix.  If  this  matrix  is  chosen 
to  be  diagonal  then  simple  "get  out  of  the  way"  strategies  will  be  executed 
ecause  a force  in  any  hand  coordinate  will  request  a velocity  modification 
In  tha  same  direction,  and  will  result  in  a reduction  in  the  felt  force 
This  modification  is  in  the  class  of  fine  motions  discussed  in  Section 
and  may  be  superimposed  on  the  gross  motion  commands,  which  are  also 
in  hand  coordinates.  The  net  command  is  then  converted  into  joint 

NoTTt  thic  and,eC  ^ meanS  °f  ReS°‘Ved  M°‘ion  Control  (reference  8). 
Note  that  the  resulting  motions  will  cause  force  _F  to  change.  Thus  a 

new  servo  loop  has  been  added.  If  F arises  from  elastic  interactions 

between  the  arm  and  its  environment,  then  a small  motion  of  the  hand 

3c  will  cause  a force  JP  according  to 

£ ■ kex 

where  x is  measured  in  hand  coordinates  and  K is  the  stiffness  of  every- 
thing between  the  force  sense:  and  the  "solid"  ground  relative  to  which 

7 “ measured-  The  resulting  equations  are  third  order  in  matrix  form. 

If  Kf  is  chosen  to  be  other  than  diagonal  or  if  zero  entries  are  placed 
strategically  on  the  diagonal,  then  other  interesting  tasks  can  be  performed 
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involving  other  strategies  besides  "get  out  of  the  way.  " See  reference  1. 

In  reference  9 a detailed  study  of  the  behavior  of  accommodation 
loops  is  made  for  the  ctse  of  a three  joint  arm  about  the  size  and  strength 
of  that  described  in  later  sections  of  this  report.  It  is  shown  that  matrices 
Kp,  Kp  and  must  all  be  designed  simultaneously,  although  some 

latitude  is  possible.  can  be  "designed"  to  the  extent  that  it  represents 
sensor  stiffness  (all  force  sensors  seem  to  be  instrumented  compliances) 
although  othc  r compliances,  such  as  the  environment  contacting  the  hand 
or  the  arm's  own  structure,  are  involved.  High  Kp  is  good  for  sensor 
design  since  the  sensor  then  introduces  little  structural  distortion,but  high 
Kp  makes  the  design  of  the  rest  of  the  servo  more  difficult.  It  can  be 
shown  that  the  product  KpKp  must  be  smaller  than  some  limit  or  else 
oscillations  will  occur  when  contact  is  made. 

Reference  9 investigates  two  manipulation  tasks  by  means  of 
servo  design  techniques  and  computer  simulation:  collision  with  a boundary 
and  putting  a peg  in  a hole.  Experience  gained  with  the  first  task  indicates 
that  good  stable  response  can  be  obtained.  The  simulated  arm,  which  is 
quite  strong  and  large,  can  be  brought  to  a stop  in  about  0.3  seconds  upon 
impact,  utilizing  only  the  control  servo.  This  indicates  that  control 
techniques  which  need  no  computer  are  possible.  In  the  second  task,  pegs 
are  put  in  holes  with  clearance  to  diameter  ratio  of  0.  001.  A fundamental 
analysis  of  this  task  is  also  made,  predicting  regions  of  success  or  failure 
in  this  family  of  tasks,  depending  or  friction,  angular  approach  error  and 
clearance  to  diameter  ratio.  Tasks  near  the  limit  of  these  success  regions 
have  been  successfully  simulated.  Figure  IV-14  shows  a sample  plot  from 
such  a simulation,  where  the  peg  approaches  the  hole  at  10  cm/sec,  with 
2°  misalignment.  The  coefficient  of  friction  is  3.  This  is  a difficult 
insertion  task.  The  plot  shows  the  rate  of  turn  of  the  peg  as  it  aligns 
itself  with  the  hole.  The  "desired  turn  rate"  is  requested  by  the  accommo- 
dation loop.  The  "actual  turn  rate"  is  the  peg's  response  to  this  request 


* work  supported  by  NSF  Grant  No.  GI  39432X  and  GI  43787. 
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I*es»red  Turn  Velocity,  rad /sec 
Actual  Turn  Velocity,  rad 'sec 


and  to  the  forces  exerted  directly  on  the  peg  by  the  hole.  As  accommodation 
builds  up,  these  foices  die  out  and  the  peg  goes  smoothly  into  the  hole. 

A one  degree  of  freedom  simulation  of  the  collision  task  has  been 
set  up  to  investigate  the  effects  of  backlash.  Backlash  can  result  from 
gear,  chain  and  spline  drives,  and  can  occur  in  power  drive  trains  or  in 
sensor)  readout  devices.  Backlash  is  not  a problem  in  put-take  industrial 
robots  or  in  devices  like  auto  transmissions,  derricks  and  so  on.  It 
causes  difficulty  in  servos  or  other  controlled  devices  which  must  reverse 
direction  as  they  seek  a commanded  position  under  tight  servo  control. 

The  issues  studied  here  are  backlash  location  and  angle  readout 
location.  One  quickly  discovers  than  an  angle  readout  with  internal 
backlash  causes  servo  oscillations  or  instabilities.  The  same  occurs  if 
a readout  is  located  on  a load  which  is  connected  to  its  drive  motor  through 
drive  train  backlash.  If  the  readout  is  on  the  motor,  however,  then  the 
accommodation  loop  still  functions,  although  not  as  effectively.  This  is 
illustrated  in  the  next  three  figures,  which  show  desired  and  actual 
velocities  of  a simple  one  degree  of  freedom  arm  colliding  with  a barrier. 
In  Figure  IV-15  there  is  no  backlash.  Curve  1 is  the  position  of  the  arm's 
endpoint,  curve  2 is  its  velocity,  curve  5 is  the  desired  position  and 
curve  6 is  the  desired  velocity,  the  latter  two  being  modified  sharply  by 
accommodation  after  the  collision  occurs  at  around  time  = 0.  18  sec. 

Stable  behavior  occurs  and  all  velocities  recede  to  zero  as  the  arm  comes 
to  rest  against  the  barrier.  Figure  IV-16  shows  the  effect  of  adding  0.005 
radians  of  backlash  between  the  motor  and  the  load.  The  load's  speed 
jumps  up  suddenly  at  time  = 0.  1 seconds  when  the  backlash  closes  and 
the  motor  first  begins  driving  the  load.  The  backlash  remains  closed 
during  contact  and  stable  behavior  results.  Figure  IV-17  shows  the  result 
when  the  backlash  of  0.  005  radians  is  shifted  from  the  load  to  the  angle 
readout.  The  high  velocity  of  the  load  near  time  = 0. 1 is  caused  by  the 
servo's  belief  that  the  load  is  not  moving,  since  the  backlash  on  the  angle 
readout  does  not  close  until  around  time  = 0.  07.  The  ultimate  result  is 
instability.  This  indicates  that  if,  in  the  previous  test,  there  were 
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additional  backlash  in  the  force  sensor,  the  result  would  be  instability. 

Thus  high  quality  force  sensing  can  make  up  for  sloppy  drive  trains  to 
some  extent,  although  in  some  cases  it  appears  that  one  must  pay  a penalty 

in  decreased  aim  speed  and  increased  contact  forces  between  tre  arm  and 
its  environment. 

E.  Error  Analysis 

An  error  analysis  is  not  an  exercise  in  pessimism  but  is  the  key 
to  understanding  whether  a proposed  design  will  in  fact  perform  as  intendel. 
It  also  points  out  reasons  for  weak  performance  and  indicates  how  and 
where  to  make  improvements.  It  shows  how  accurate  sensors  need  to  be, 
for  example,  or  how  stiff  compliant  elements  must  be  made,  in  order 
that  desired  performance  goals  be  met.  Error  analyses  usually  do  not 
concern  themselves  with  malfunctions. 

Error  analyses  can  be  carried  out  in  three  areas  of  assembly 
arm  studies: 

• the  arm  itself 

• the  objects  it  interacts  with 

• the  strategies  it  utilizes  for 
carrying  out  tasks 

A general  procedure  for  determining  errors  in  manipulator 
arms  is  discussed  in  reference  2 • The  error  sources  analyzed  are 
angle  sensors,  bearing  location  and  eccentricity,  structural  compliance 
and  thermal  expansion.  An  appropriate  arm  design  should  balance  these 
contributions  to  error  so  that  no  one  source  dominates  while  effort  is 
expended  to  reduce  the  others.  Some  types  of  error  are  predictable  ai*id 
can  be  compensated  while  others  are  random.  This  analysis  method  was 
used  in  the  design  of  the  arm  described  in  Section  VII  *o  specify  angle 
readout  accuracy  and  to  determine  that  certain  bearings  and  shafts  were 
too  compliant. 
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formally  one  is  not  interested  in  the  accuracy  of  an  arm  itself 
but  rather  the  combined  accuracy  of  the  arm  and  the  items  it  interacts 
with.  Errors  can  appear  in  the  objects  grasped  by  the  arm.  in  the  exact 
position  of  the  object  in  the  gripper,  and  in  the  position  of  the  assembly 
into  which  the  grasped  object  is  to  be  placed.  One  quickly  concludes,  for 
example,  that  it  is  fruitless  to  build  ultra-accurate  arms  to  move  floppy 
rubber  hoses  around  (unless  special  precautions  are  taken).  A conclusion 
of  ongoing  assembly  task  analysis  is  that  automated  assembly  will  involve 
many  gripping  tools  whose  major  function  is  tD  accurately  locate  a grasped 
object  with  respect  to  the  gripper. 

Error  analysis  of  strategies  is  really  an  investigation  in  depth  of 
the  strategies  themselves.  If  execution  of  a strategy  requires  that  a force 
of  no  more  than  10  newtons  be  exerted,  then  success  depends  on  how 
accurately  one  can  measure  the  force  and  how  quickly  one  can  cease  to 
increase  applied  force  once  the  10  newton  level  has  beer  reached.  Other 
strategics  may  call  for  the  determination  of  the  direction  in  which  force 
is  acting,  There  will  be  an  error  in  this  determination.  If  success  of 
the  strategy  depends  critically  on  the  accuracy  of  this  direction  measure- 
ment, the  strategy  may  be  failure -prone.  Thus  we  see  that  hardware  and 
strategies  interact;  a good  strategy  on  paper  may  be  beyond  an  arm's 
capability;  shortcomings  in  an  arm  may  force  one  to  employ  additional 
compensating  strategies  at  a cost  in  task  completion  time. 

In  this  vein,  we  have  identified  a number  of  arm  design 

inadequacies  which  detract  from  performance  in  various  ways: 

» 

• structural  compliance  (task  completion 
time  is  lengthened  while  one  waits  for 
vibrations  to  die  out,  or  the  arm  must 
be  moved  slowly) 

• backlash  (to  ensure  repeatibility,  the 
arm  must  be  moved  slowly  near  the 

end  of  a gross  motion;  reversing  direction 
during  fine  motions  leads  to  errors; 
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attempts  to  servo  with  force  feedback 
may  cause  instabilities;  one  may  have 
to  adopt  a strategy  of  "grounding"  the 
arm  on  some  solid  object  just  before 
beginning  fine  motion  in  order  to 
guarantee  that  one  knows  where  the  arm 
is) 

• inadequate  control  servos  (task  completion 
time  is  lengthened  due  to  the  need  to  move 
the  arm  slowly;  control  gains  are  higher 
than  necessary  and  vibrations  may  occur; 
payload  cannot  be  changed  without  upsetting 
the  servo) 

• unbalanced  actuator  capability  or  unbalanced 
structural  rigidity  (arms  with  weak  or 
compliant  wrists  seem  to  be  common;  a 
compliant  shoulder  is  less  common  but  is 

■ 

worse  in  that  the  whole  arm  can  be  set  into 
vibration;  a prototype  arm  with  this  problem 
exists  in  a large  company's  laboratory;  both 
inadequacies  result  in  wasted  resources, 
servo  problems,  inability  to  complete  tasks 
or  longer  task  completion  times) 

F.  Summary  of  Design  Tools 

The  following  list  comprises  tools  developed  during  this  and 
other  studies  and  utilized  in  specifying  the  design  of  the  arm  described 
in  the  following  sections: 

• TOAD  (teleoperator  arm  design  program)  - 
computer  programs  to  write  kinematic  and 
dynamic  equations  of  motion  for  arms 

• speed /payload/to rr.ue  analyses  and 
simulations  to  size  actuators 
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• actuator  technology  studies 

• servo  analysis  and  simulation  of 
accommodation  strategies  and  other 
fine  motion  methods,  including  effects 
of  compliance  and  backlash 

• structural  analysis  and  its  relation 
to  servo  control  of  arms 

• servo  control  techniques  for  determining 
dynamic  performance 

• error  analysis  to  criticize  arm  designs 
and  strategies  for  assembly 
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V.  DISCUSSION  OF  DRAPER  LAB  ARM  DESIGN  (PQPE\E) 

A.  Di.scription  of  Arm 

The  Draper  Lab  arm  was  designed  as  a research  tool  for 
automatic  assembly.  The  basic  requirements  were  that  the  device  be 
capable  of  assembling  items  as  large  as  a cube  one  meter  on  a side, 
be  capable  of  picking  up  parts  as  heavy  as  20  kilograms,  be  capable  of 
slewing  1 1/2  radians  in  all  axes  in  0.5  sec  unloaded,  have  an  overall 
absolute  accuracy  of  less  than  1 mm  (0.04  in)  and  be  capable  of  quickly 
interchanging  tools  or  end  effectors  used  for  different  assembly  tasks. 
Designing  to  these  difficult  specifications  brings  out  many  problems  and 
solutions  applicable  to  mini-robot  arms. 

While  there  are  a number  of  different  kinematic  configurations 
that  could  successfully  be  used,  an  overhead  hung  six  degree  of  freedom 
elbow  type  of  arm  design  was  selected  as  it  was  quite  compact  for  the  work 
volume  it  could  access  and  was  judged  to  be  more  easily  adaptable  to 
existing  assembly  lines.  A rigid  gallows  structure  that  bolts  to  a work 
table  was  designed  to  suspend  the  arm  (see  figure  V-l).  The  horizontal 
beam  of  this  structure  can  be  set  at  different  heights  for  different  tasks. 
Eventually  this  movement  was  to  be  powered  although  not  to  be  used  as  a 
high  speed  degree  of  freedom.  The  arm  proper  had  shoulder  azimuth  and 
elevation  degrees  of  freedom,  an  elbow  ele*  ation  degree  of  freedom,  and 
wrist  roll,  pitch,  and  yaw  degrees  of  freedom.  The  links  between  the 
shoulder  and  elbow  and  between  the  elbow  and  wrist  were  idealized  as  being  an 
equal  0.45  m (~  17.75  in)  in  length.  However,  it  was  not  possible  to 
design  a universal  joint  for  the  wrist  that  would  allow  sufficient  movement 
for  both  pitch  and  yaw.  Therefore  the  pitch  and  yaw  axes  are  separated 
by  82.  5 mm  (~  3.25  in)  and  the  0.45  m length  between  the  elbow  and  wrist 
extends  to  a point  equidistant  between  the  pitch  and  yaw  axis.  The  idealized 
load  point  was  considered  to  be  0.  20  m (~  8 in)  from  this  point.  Thus,  the 
overall  straightout  length  of  the  arm  is  1.  10  m (~  43.  3 in). 
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Figure  V-l 

Side  View  of  Draper  Arm,  Work  Surface,  and  Support  Structure 
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All  of  the  degrees  of  freedom  are  driven  by  direct  coupled  single 
vane  hydraulic  actuators  with  a working  pressure  of  14  x 106  Pascals 
(~2000  PSI).  At  this  pressure  the  shoulder  actuators  will  develop 
690  Nt-m  (~  510  ft  lb)  of  torque;  the  elbow  actuator,  350  Nt-m  (~260  ft  lb) 
of  torque  and  the  wrist  actuators,  82  Nt-m  (^60  ft-lb)  of  torque.  Except 
for  the  shoulder  azimuth  and  the  wrist  roll,  the  bearings  for  the  actuators 
also  act  as  the  bearings  for  the  structure.  Due  to  the  large  moment  loads 
possible  on  the  shoulder  azimuth  and  the  wrist  roll  degrees  of  freedom, 
additional  larger  diameter  bearings  were  incorporated.  Where  possible 
the  actuator  housings  form  part  oi  the  arm  structure.  The  wrist  roll 
actuator  is  bolted  directly  to  the  elbow  actuator.  The  wrist  pitch  and  yaw 
actuators  were  designed  with  a single  Siamese  housing.  To  avoid  backlash, 
connections  between  the  actuator  shafts  and  structural  yokes  were  made 
using  friction  clamps  as  opposed  to  keyways  or  splines.  In  all  degrees 
of  freedom,  the  position  feedback  sensor,  which  is  a dual  speed  pancake  resolver 
(IX  and  6 4X). is  designed  into  the  actuator  housing  and  uses  the  actuator 
bearings. 


80 


B.  Critique  of  POPEYE1  as  a Research  Tool 

The  POPEYE  design  reflects  the  need  for  a research  arm  that 
attempts  to  meet  the  research  goals  as  reviewed  in  Section  I of  this  report. 
The  design  reflects  the  dual  attributes  of  a good  pick-and-place  arm  and 
an  assembler.  These  attributes  are: 

For  Pick-and- Place 

• Speed 

• Accuracy 

• High  Load  Capacity 

• Large  Work  Volume 

For  Assembly 

• Accuracy  (good  positional  accuracy) 

• Accurate  Control  of  Small  Motions 
(good  rate  control  and  high  damping) 

• Accurate  Control  of  Forces  at  the  Hand 
(accurate,  wide  dynamic  range,  low  drift 
wrist  force  sensor) 

• Versatile  Set  of  Articulations  (at  least  six 
degrees  of  freedom  with  the  ability  to 
reach  around  objects) 

1.  Advantages  of  POPEYE  Design 

Cf  course  the  arm  could  not  be  designed  to  optimize  all 
attributes.  However,  the  design  does  have  inovations  that  should  result 
in  an  arm  that  will  have  excellent  kinematic  and  dynamic  behavior.  The 
more  important  of  these  design  inovations  are: 

a.  Overall  kinematics:  six  degrees -of- freedom, 
shoulder  connected  to  a stiff  overhead  beam 
(see  figure  \ -1),  an  elbow  which  all  iws 
articulation  around  five  sides  of  t isk.  The 
large  work  volume  afforded  by  this  design 
should  also  help  with  the  parts  feeding 
problem. 

Because  of  its  husky  lower  arm,  this  design  has  come  to  be  called  POPEYE. 
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b.  Loads  connected  directly  to  the  actuators 
thus  eliminating  backlash  due  to  gearing. 

c.  Position  feedback  sensors  — 1 and  64  speed 
pancake  resolvers  wound  on  the  same  pole 
pieces  — designed  into  the  motor  housing  and 
on  the  load  shaft.  This  eliminates  shaft 
windup  and  backlash  between  the  actuator 
output  and  the  feedback  element  — often  a 
source  jf  servo  instability. 

d.  The  use  of  the  two  speed  resolvers  has  many 
advantages.  Among  these  are: 

(1)  16  bits  position  accuracy 

(2)  18  bits  servo  quantization 

(3)  A rate  signal  derived  from  the 
Phase  Lock  Loop  method  of 
reading  out  and  digitizing  the 
resolver  signals 

(4)  The  64  speed  winding  gr  eS  the 
equivalent  of  a 64  speed  gearup  of  a 
tachometer  without  introducing  the 
extra  apparent  inertia  of  real  gears, 
backlash  or  shaft  windup.  This  in 
turn  results  in  a sensitive  rate  signal 
(approximately  1 volt/rad/sec) 

e.  The  hydraulic  vane  actuators  were  designed 
without  internal  (vane)  seals.  This  has  the 
advantage  of  eliminating  much  of  the  cause  of 
stiction  and  also  aided  in  servo  damping. 

f.  Th3  design  of  a six-degree-of-freedom,  wide 
dynamic  range  force  sensor  array.  Ti:is  will 
be  incorporated  in  the  wrist  force  sensor  and 
used,  in  conjunction  with  the  control  computer, 
to  resolve  the  forces  at  the  hand  into  the  six 
components  — three  rectilinear,  and  three 
torque. 


. 

j 
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2.  Disadvantages  of  POPEYE  Design 

The  principle  disadvantage  of  the  POPEYE  design  is  the 
cost  of  producing  it.  The  hydraulic  motors,  motor  and  bearing  houses, 
arm  linkages,  force  sensor  array  and  housing  all  had  to  be  designed 
The  machining  of  all  these  parts  will  be  relatively  expensive  compared 
to  present  systems;  however,  the  inherent  reliability  of  its  very  clean 
design  offers  compensating  advantages  as  a research  tool. 
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V *•  SUMAI ARY  OF  DRAPER  LAB  ARM  SPECIFICATIONS 

A.  Dexterity 


1.  Six  degrees  of  freedom  exclusive  of  end  effector,  based  on 
minimum  requirement  for  general  spatial  motion.  All  degrees  of  freedom 
are  revolute  (as  opposed  to  telescoping  or  prismatic)  and  are  embodied 

in  the  arm  proper.  See  Figure  V-l  for  a general  view  of  the  arm. 

2.  Angular  excursions  of  joints  (Constrained  by  practical 
joint  and  actuator  design) 


Shoulder  Azimuth 

+ 150° 

Shoulder  Elevation 

+ 130° 

Elbow  Elevation 

+ 135° 

Wrist  Roll 

+ 150° 

Wrist  Pitch 

+ 135° 

Wrist  Yaw 

+ 100° 

B.  Size 

Maximum  reach  at  wrist  point  0.90  in  (35.4  in) 

Minimum  reach  of  wrist  point  0.  38  m (15.  0 in) 

As  the  length  of  different  end  effectors  and  sensors  will  vary, 
the  wrist  point  is  used  as  a datum.  The  wrist  point  is  considered  to  a 
point  equidistant  between  the  wrist  pitch  and  the  wrist  yaw  axes. 

C.  Accuracy 

A single  point-positioning  accuracy  of  better  than  1 mm  (or  40 
mils)  was  specified.  The  figures  listed  below  are  the  result  of  many 
factors,  size,  strength,  speed,  etc.  These  worst-case  errors  are  defined 
statically  with  the  wristpoint  as  a datum. 

1.  Basic  Resolver  Error  (+LSB): 

Elevation'  = +.13  2 mm  (+.0052  in) 

Azimuth  = +_.  189  mm  (+.0035  in) 

2.  Repeatability  (+1/4  LSB): 

jt.  ~ 

Elevation  = + . 033  mm  (+.  0013  in) 

Azimuth  = +.022  mm  (+.0009  in) 

* Two  resolvers  in  tandem 
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3.  Structural  Error  (RMS)  - +.  26  mm  (+.  0104  in) 

4.  Vertical  Droop  (unloaded)  - . 16  mm  (.0062  in) 
Accuracy  for  "fine"  motions  has  not  been  defined. 

D.  Pe  rformance 

Fine- motion  operating  bandwidth:  10Hz 

Gross-motion  "task"  time:  0.5  sec. 

Stiffness  (referred  to  wristpoint): 

Arm  extended  - 1050  Nt/mm  (6000  Ib/in) 

Elbow  @ 90°  = 1230  Nt/mm  (7000  Ib/in) 

Lowest  structural  natural  frequency  = 3 0 Hz 

Inertia  @ shoulder  with  10  Kg  load  * 22-1/2  Kg-M2  (200  in-# -sec 

The  gross  motion  task  referred  to  above  is  to  move  any  or  all 
axes  of  the  unloaded  arm  in  a 90°  slew  motion  stop  to  stop. 

E.  Subsystem  Specifications 
1.  Actuators 

TyPe:  Hydraulic,  single  vane,  direct  acting 

Seals:  no  internal,  shaft  seals  on'y 

System  Press:  17.5  MPa  (~  2500  PSD 

Displacement: 

Shoulder  51.  1 x 10'6m3/rad  (3. 12  in3/rad) 

Elbow  25.  6 x 10'6m3/rad  (1.56  in3/rad) 

Wrist  6.22  x 10'6m3/rad  (0.38  in3/rad) 

Rated  Actuator  Torques  @ 14.  0 MPa  (~  2000  PSI) 

Shoulder  Azimuth  and  Elevation  690  nt  M (510  ft  #) 
Elb°w  350  nt  M (258  ft  #) 

All  Wrist  82  nt  M (61  ft#) 

Speed  (at  rated  torque):  6 rad/sec 

Valve  pressure  drop  at  speed:  <3.5  MPa  (500  PSI) 


85 


2.  Angular  Position  i'ranscucers 


Type: 

Two  speed.  IX  and  64 X; 
wi rewound  pancake  resolvers 

Size: 

76.  3 mm  (3  in)  O.  D. 
44.  5 mm  (1. 74  in)  1.  D. 

Excitation: 

15V.  1000  iiz 
1/2  watt  /unit 

Transformation 

Ratio: 

IX  : 1 to  1 

64X  : 4 to  1 

Accuracy: 

IX  : 1.5  deg  (8  bits) 
64X  : 20  sec  (16  bits) 

Speed: 

adjustable  - a tracking  Phase- 
loop  is  used 

Tachometer 

Output: 

Supplied  by  PLL,  analog 

Mounting: 

Integral  with  actuators 

3.  Wrist  Force  Sensor 

TyPe:  laser  interferometer 

Degrees  of  freedom:  6 

Full  Scale  Force:  500  nt  (110  lbs) 

Overload  Force:  5000  nt  design  goal  (1100  lbs) 

Displacement:  0.04  mm  (0.0016  in)  full  scale 

Resolution:  14  bits  or  1:8000 
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VII.  SI  HSYSTKMS 


A.  Actuator  Selection  and  Design 
!.  lJoi\cr  Source  Selection 

The  major  decision  in  the  selection  of  the  actuators  for  the 
manipulator  arm  was  whether  to  use  I).  C.  torque  motors  or  to  use 
either  hydraulic  motors  or  hydraulic  actuators.  Both  have  their 
advantages.  The  main  advantage  of  the  electric  motors  is  that  they 
are  considerably  easier  to  control  than  the  combination  of  hydraulic 
servo  valves  and  hydraulic  actuators.  In  general,  it  is  easier  to  design 
for  wiring  for  an  electric  motor  than  for  hydraulic  lines.  The 
hydraulic  systems  have  a potentially  serious  leakage  problem. 

Noise  may  be  somewhat  more  of  a problem  with  a hydraulic  system. 

1 he  main  disadvantage  of  a I).  C.  torque  motor  is  that  its  torque 
to  weight  ratio  is  much  lower  than  that  of  a hydraulic  motor  or  actuator. 

In  order  to  increase  the  torque  to  weight  ratio  of  the  electric  imtor.it 
would  probably  be  necessary  to  use  mechanical  gearing  of  some  type. 

In  general,  the  use  of  gearing  will  cause  backlash  which  will  in  turn 
cause  control  problems. 

It  should  be  realized  that  the  choice  of  actuator  types  is  not 
independent  of  the  assembly  machine  or  assembly  arm  configuration. 

If  the  assembly  machine  employs  linear  degrees  of  motion,  preloaded 
zero  backlash  ball  screws  can  be  used  to  amplify  the  force  available  from 
an  electric  motor.  Also,  if  the  degrees  of  freedom  can  be  arranged  so 
that  the  motor  masses  do  not  create  large  inertias  and/or  large 
gravitational  forces  that  must  be  overcome  by  other  motors. the  torque 
to  weight  ratio  is  less  important. 

For  reason*  that  are  detailed  in  section  B on  Kinematic  Configura- 
tion, an  elbow  type  of  arm  design  was  chosen  with  all  six  degrees  of  freedom 
invested  in  the  arm  proper.  To  achieve  the  necessary  drive  stiffness  and 
to  ovoid  backlash,  remote  drive  mechanisms  were  ruled  out.  Therefore,  it  is 
necessary  that  the  shoulder  actuators  have  sufficient  torque  to  overcome 
the  inertia  and  gravitational  loads  caused  by  the  elbow  and  the  wrist 
actuators  in  addition  to  those  caused  by  the  end  effector  and  load.  The 
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elbow  actuator  must  have  sufficient  torque  to  overcome  the  inertia  and 
gravitational  loads  caused  by  the  wrist  in  addition  to  those  of  the  ena 
effector  and  load.  This  causes  a pyramiding  effect  on  the  required 
ac  t lator  torque  which  virtually  rules  out  any  consideration  of  using  direct 
drive  D.  C.  torque  motors.  Thus,  if  electric  motors  were  to  be  used  they 
would  need  to  be  geared,  probably  in  the  range  of  10:1  to  20:  1.  While  it 
might  be  possible  to  develop  a zero  backlash  gearing  system  using 
preloaded  gear  pairs  or  perhaps  using  all  rolling  element  cycloidal  gear 
reducers  or  a counter  driving  double  motor  arrangement  on  each 
axis,  it  was  decided  that  the  more  straight-forward  approach  would  be 
to  use  either  a hydraulic  motor  or  a hydraulic  actuator. 

2.  Hydraulic  Motor/ Actuator  Design 

Preliminary  design  work  was  done  for  both  a continuous 
rotation  hydraulic  motor  and  for  a single  vane  hydraulic  rotary  actuator 
capable  of  up  to  300  of  rotation.  The  hydraulic  motor  design  was  for  an 
orbital  gerotor  type  of  motor.  This  motor  essentially  consists  of  a rotor 
with  externally  cut  cycloidal  gear  teeth  that  rotates  inside  a stator  with 
internally  cut  cycloidal  gear  teeth.  See  Figure  VlI-1,2.  As  the  stator 
has  one  more  tooth  than  the  rotor,  the  rotor  will  make  n^  orbits  per 
rotation  where  is  the  number  of  teeth  or  lobes  on  the  rotor.  If  the 
rotor  rotation  is  used  as  the  shaft  output,  a planetary  gear  effect  with  a 
ratio  of  n^il  will  be  achieved  without  resorting  to  external  gearing.  This 
effective  gearing  has  the  same  effect  as  external  gearing  in  raising  the 
apparent  torque  and  stiffness  of  the  hydraulic  motor. 

While  orbital  gerotor  motors  are  commercially  available 
from  several  sources,  they  do  not  appear  to  be  suitable  for  use  as  servo 
motors,  in  the  commercial  motors,  the  rotor  rotation  is  picked  up  with  a 
shaft  that  has  loose  fitting  balled-over  splines  at  both  ends.  This  shaft 
is  free  to  wobble  which  allows  the  rotor  to  orbit  while  preserving  the 
rotation.  Unfortunately,  this  shaft  with  its  loose  fitting  splines  becomes 
a source  of  backlash  and  wear.  In  our  design,  the  splined  shaft  was 
replaced  with  a pair  of  freely  rotating  cranks.  The  free  rotation  of  the 
cranks  allows  the  rotor  to  orbit  while  the  cranks  will  rotate  as  a pair 
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to  preserve  the  rotation  of  the  rotor.  This  feature  not  only  eliminates  the 
backlash  but  also  makes  the  motor  mechanically  stiffen  and  more  compact. 

The  initial  design  was  for  a motor  that  would  produce 
approximately  625  Nt-m  of  torque  at  a working  pressure  of  17.5  x 10^ 

Pascals  (460  ft-lbf  at  2500  PSD.  This  estimated  torque  is  found  quite 
easily  by  multiplying  the  fluid  displacement  per  radian  rotation  of  the 
output  shaft  by  the  working  pressure.  The  working  pressure  is  the  pump 
pressure  minus  an  estimated  pressure  drop  due  to  losses  in  the  fluid  lines  and  the 
servo  valve.  This  pressure  drop  is  proportional  in  a non-linear  manner 
to  the  flow  rate  and  the  servo  valve  opening.  The  other  parameter  of 
interest  is  the  actuator  stiffness  which. along  with  the  arm  inertia.is  needed 
to  predict  the  open  loop  resonant  frequency.  The  compliance  of  the 
actuator  is  largely  due  to  the  bulk  modulus  of  the  hydraulic  fluid.  Other 
factors  that  may  contribute  are  hydraulic  line  compliances  and  output 
shaft  tore  -onal  compliance,  etc.  As  the  servo  valves  are  mounted  directly 
on  the  actuators  and  the  shaft  stiffness  is  treated  in  the  section  on 
structural  stiffness,  only  the  compliance  due  to  the  bulk  modulus  is 

treated  here.  For  a piston  type  hydraulic  actuator  it  can  be  shown  that 
the  stiffness  is 

K = 2/3A2 

V. 

i 

where  /3  is  the  hydraulic  fluid  bulk  modulus  in  Pascals  (or  PSI),  A is 
piston  area  in  square  meters  (or  sq.  in.  ) and  V.  is  the  fluid  volume 
between  one  side  of  the  piston  and  the  servo  when  the  piston  is  centered  in 
cubic  meters  (or  cu.  in.  ).  For  a rotary  actuator  or  a motor,this  becomes 

K = 2/3D  2 
r 

i 

where  Dr  is  the  displacement  per  radian  in  cubic  meters  (or  cu.  in.  ). 


See  Fluid  Power  Control  by  Blackburn,  Heethof,  and  Shearer,  M.  I.  T. 
Press,  1960,  pages  510-516. 
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For  a non-orbital  motor  Vi  becomes  ■nT>r  assuming  that  the  non-displaced 
volume  is  neglible  (this  may  or  may  not  be  a good  assumption  depending 
on  the  motor  design).  For  an  orbital  type  motor 

V.  = ttD 

i r 

n 

r 

which  again  makes  the  assumption  that  the  non-displaced  volume  is 
neglible,  a fairly  good  assumption  for  the  motor  that  was  designed.  Thus, 
the  stiffness  is  given  by 

K --  2(3n  D 

r r 

7 r 

For  motors  of  equal  displacement  per  radian  and  thus  equal  output  torque 
at  a given  pressure, the  stiffness  of  the  orbital  motor  will  be  greater  than 
that  of  a non-orbital  hydraulic  motor  by  a factor  of  n^.  For  a single  vane 
actuator 


and 


Vi 


7 


K 


= 4/3  D 

r 


“FT 


where  R is  the  maximum  rotation  of  the  actuator  in  radians. 

Q 

Using  1.5  x 10  Pascals  (~  220,  000  PSI)  as  the  bulk  modulus 
(the  actual  bulk  modulus  for  phosphate  ester  is  2.  67  x 109  Pascals  or 
387,000  PSI)  and  with  nr  equal  to  12  and  Dr  equal  to  35.7  x 10~6  cubic 
meters  per  radian  (~  2.  2 cu  in/rad),  the  open  loop  stiffness  for  the  designed 
orbital  motor  is 

K = 4.  1 x 105Nt-m/rad(~  3 x 105  ft-lb/rad) 

While  the  orbital  hydraulic  motor  inherently  has  a much 
higher  torque  density  (torque  to  weight  ratio)  and  a much  higher  stiffness 
than  a non-orbital  motor  or  a rotary  actuator,  it  was  decided  that  there 
would  be  less  risk  in  placing  the  primary  emphasis  on  the  design  of  single 
vane  rotary  actuators  for  the  arm.  The  main  design  problem  with  the 
orbital  motor  was  in  determining  the  tolerances  and  clearances  to  allow  it 


to  run  smoothly  but  not  leak  excessively.  Although  the  orbital  motor  would  have 
superior  performance  it  would  probably  require  more  of  a development 
effort.  A further  problem  was  that  there  was  only  one  source  for  the 
precision  gerotor  elements  and  they  would  not  promise  quick  delivery  on 
anything  not  normally  stocked  even  though  the  tooling  existed. 

1’he  design  of  the  single  vane  hydraulic  actuator  is  similar 
in  principle  to  that  of  the  commercially  available  vane  actuators.  However, 
as  commercial  actuators  designed  for  high  pressure  hydraulics  were  not 
available  in  a range  of  sizes  suitable  for  use  as  wrist  actuators,  it  was 
necessary  to  design  our  own  vane  actuators.  Also  by  designing  special 
actuators,  several  very  important  advantages  could  be  realized.  The  most 
important  functional  difference  is  that  our  design  has  no  seals  except  for 
low  pressure  seals  on  the  output  shafts, and  relies  on  close  tolerances 
between  the  vane  and  the  housing  to  maintain  low  leakage  rates.  Eliminating 
the  seals  eliminates  the  principal  source  of  friction  in  the  actuator  and  will 
allow  smoother  control.  The  other  important  functional  difference  is  that 
the  position  transducei  - a pancake  resolver  with  a single  speed  and  64 
speed  winding  - is  built  into  the  actuator.  By  designing  our  own  actuators 
it  was  also  possible  to  use  the  actuator  cases  as  part  of  the  arm  structure 
and  to  use  the  actuator  bearings  as  the  arm  bearings  in  four  of  the  axes 
(in  all  cases  the  actuator  bearings  also  serve  as  the  resolvers' bearings ). 

By  accurately  sizing  the  actuators  to  meet  the  desired  performance 
specifications  it  was  possible  to  minimize  their  weight  and  overall  size. 

It  was  also  possible  to  design  the  servo  valve  manifold,  the  cross-over 
pressure  relief  valves,  the  pressure  transducer  ports  and  the  low  pressure 
drain  relief  valve  and  manifolding  into  the  case.  See  Figure  V 1 1 - 3 a and  b. 

3.  Vane  Actuator  Design  Specifications 

The  specific  sizes  of  the  actuators  for  the  differed  axes 
were  found  by  computer  simulation.  See  Section  IV-B.  A somewhat 
arbitrary  performance  specification  on  slew  time  was  used  as  basis  for 
this  simulation  as  it  was  believed  that  the  ability  to  slew  rapidly  in  order 
to  change  end  effectors  or  tools  and  to  fetch  parts  was  an  important 
function.  The  initial  specification  was  that 
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all  axes  be  capable  of  slewing  11/2  radians  (~  90  degrees)  in  one  second 
with  a 10  kilogram  load.  As  the  arm  would  probably  slew  much  more 
frequently  with  either  no  load  (to  change  the  end  effector  or  to  fetch  a new 
part)  or  with  a light  load,  the  performance  specification  was  changed  so 
all  axes  would  be  capable  of  slewing  11/2  radians  in  1/2  second  with  no 
load.  This  is  a somewhat  more  stringent  requirement  for  the  elbow  and 
shoulder  actuators.  See  Figure  IV-1.  A model  ror  the  mass  and  inertia  was 
developed,  working  from  the  wrist  requirements  back  by  estimating  the  mass 
for  the  end  effector  and  wrist  structure.  This  yielded  a torque  requirement  for 
the  wrist  actuators.  From  this,  the  actuator  could  be  sized  and  the  mass 
estimated.  This,  along  with  the  required  structure  and  the  previous 
estimated  masses  for  the  end  effector  and  wrist  structure,  determines  the 
torque  requirement  for  the  elbow  actuator.  Then,  knowing  the  size  of 
the  elbow  actuator,  the  torque  requirements  for  the  shoulder  actuator  can 
be  determined.  See  figure  VII-4  for  the  discrete  mass  model  used  for 
the  simulation.  The  simulation  yielded  torque  requirements  of  82  Nt-m 
(~  60  ft-ib)  for  the  wrist  actuators,  350  Nt-m(~  260  ft-lb)  for  the  elbow 
actuator  and  690  Nt-m(~510  ft-lb)  for  the  shoulder  actuator.  For  a single 
vane  actuator  the  torque  is  given  by 

T = Pi^\2"j2 

where  P is  the  working  pressure  (pump  pressure  minus  an  allowance  for 
losses),  l is  the  length  of  the  vane,  r,  is  the  outer  radius  of  the  vane  and 
r9  is  the  inner  radius  of  the  vane.  The  working  pressure  was  set  to 

" 6 fi 

14  x 10  Pascals  U,  2000  PSI)  with  a pump  pressure  of  17.5  x 10  Pascals 
(~  2500  PSI).  The  actual  dimensions  of  the  shoulder  and  elbow  actuators 
were  set  by  using  the  largest  possible  bearing  size  (largest  bore) 
consistent  with  mounting  the  pancake  resolver  as  both  the  output  shaft 
torsional  stiffness  and  the  bearing  radial  stiffness  were  critical.  A single 
pair  of  35  mm  extra  light  angle  contact  bearings  (ABEC  7)  were  used  in 
the  elbow  actuator  and  two  duplex  pairs  were  used  in  the  shoulder  actuators. 
The  inner  radius  of  the  vane,  rg>  was  set  at~2.22  cm  (~0.  875  in),  the  outer 
radius,  r j,  was  set  at  ~ 4.  60  cm(~  1.  812  in)  and  the  length  of  the  vane  for  the 
shoulder  actuator  was  setat~  6.  34  cm(~2.  50  in)while  the  length  of  the  vane  for  the 
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elbow  actuator  was  set  at  ~ 3.  17  cm(  ~ 1.  25  in).  The  wrist  actuators 
were  designed  around  a single  pair  of  25  mm  bore  extra  light  angle 
contact  bearings.  The  inner  vane  radius,  r2<  was  set  to  ~ 1. 90  cm 
0.75  in),  the  outer  vane  radius,  r{.  was  set  to  ~ 3.  17  cm  (~1.25  in), 
and  the  vane  length  was  set  to  ~ 1. 90  cm  (~  0.  75  in).  In  order  to  minimize 
leakage, the  clearances  between  the  vane  and  the  housing  were  designed  to 
be  between  0.  008  mm  (0.  0003  in)  and  0.  018  mm  (0.  0007  in).  The  hydraulic 
leakage  around  the  vane  and  through  other  clearances  is  given  by 


where  b is  the  clearance,  w is  the  total  width  of  the  leakage  path  and 
L is  the  length  of  the  leakage  path  along  the  flow  direction,  ^ is  the 
absolute  viscosity,  and  (Pj-Pg)  *s  *^e  Pressure  difference  across  the 
vane.  I he  important  parameter  is  b,  as  the  leakage  flow  is  proportional 
to  the  third  power  of  the  clearance,  i.  e. , doubling  the  allowed  clearance 
will  increase  the  leakage  eight-fold. 


The  required  servo  valve  size  is  determined  by  the  flow 
rate  at  the  maximum  rotation  velocity  plus  the  leakage  flow.  This  total 
flow  rate  should  not  cause  a pressure  drop  across  the  servo  valve  greater 
than  the  pump  pressure  minus  the  working  pressure  or  in  *his  case 
~ 3.5  x 10  Pascals  (~  500  PSD.  If  the  actuator  traverses  1.5  radians 
in  0.5  seconds, the  maximum  velocity,  assuming  a triangular  velocity 
profile,  is  6 radians  sec.  For  the  shoulder  actuators, the  required  flow 
rate  is  ~0.  3 x 10  m /sec  with  an  allowed  pressure  drop  of  3. 5 x 106 
Pascals  across  the  servo  valve  (~  18  CIS  @ 500  PSI  pressure  drop).  A 
conservative  servo  valve  choice,  allowing  for  a leakage  flow  with  clearances 
of  0.  025  mm  (~  0.  001  in)  and  a hydraulic  fluid  temperature  of  52°C 
(125  F),  is  the  stock  Moog  series  34  aerospace  servo  valve.  A Moog 
series  32  servo  valve  was  specified  for  the  elbow  actuator  and  Moog 
series  31  servo  valves  were  specified  for  the  wrist  actuators.  The 
aerosoace  valves  were  selected  for  their  small  size  and  mass  at  a given 
flow  performance.  There  is  a price  penalty  but  it  is  not  that  significant 
for  small  quantities  (the  quantity  discount  is  much  higher  for  the  so-called 
commercial  valves). 
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B.  Structure 


1-  Mechanical  Propertiv*s 

a.  Requirements  and  Materials 

1'he  design  of  the  load-carr\ mg  members  both  movable 
and  stationary  is  constrained  bv  a few  important  (and  interrelated) 
requirements  necessary  to  achieve  the  stated  system  goals.  Among  these 
are: 

(1 ) minimum  weight 

(2)  maximum  stiffness 

(.'))  sufficient  strength  and  fatigue  life 

(4)  lowest  resonance  t j be  above  25  to  .'iOHz 

1 he  minimum  weight  property  reduces  power  requirements 
insofar  as  the  arm  is  a significant  fraction  of  the  total  mass.  I.ower 
mass  means  that  servo  gains  can  be  relaxed  somewhat  and  still  obta-n 
reasonable  positional  accuracy.  I.ower  gain  requirements  in  turn  enhance 
gain  and  phase  margins. 

We  desire  maximum  stiffness  so  we  can  know  where  the 
hand  is  under  varying  load  conditions.  It  is  desirable  to  know  this  without 
relying  on  external  devices  (wrist -trackers)  and  compensating  routines 
in  the  software.  A stiff  arm  allows  accurate  position  data  with  only  the 
use  of  good  encoders  or  resolvers  at  the  joints. 

Sufficient  strength  is  available  from  a wide  variety  of 
materials.  Considering  the  loads  we  have  in  mind  and  the  endpoint 
tolerances,  stress  is  less  a problem  than  strain. 

The  25  flz  requirement  stems  from  the  relation  between 
servo  banawidth  and  structural  vibration.  This  is  discussed  at  length  in 
Section  IVC. 

Table  1 lists  a few  candidate  materials.  To  choose  on 
the  basis  of  weight  and  stiffness,  the  stiffness/weight  ratio  is  included. 

On  this  basis  alone,  the  best  material  is  Beryllium.  Without  digressing 
into  all  the  specific  problems  inherent  in  the  use  of  Beryllium,  one  should 
realize  that  toxicity,  stress-corrosion,  cost  and  reluctance  to  fabrication 
are  all  severe  compared  to  the  other  candidate  materials. 
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TABLE  I - SOME  MATERIAL  PROPERTIES 


An  important  question  is  whether  there  is  an  upper  bound 
to  the  stiffness  requirement  independent  of  materials  selection.  Other 
components  will  incur  a certain  amount  of  positional  error  by  themselves, 
among  them:  bearing  and  encoder  eccentricity,  bearing  play  and 
elasticity  under  load. 

We  do  not  need  to  worry  too  much  about  the  stiffness  of 
the  actuators  themselves  as  long  as  there  is  feedback  of  some  kind  to 
compensate  for  it,  and  the  stored  energy  component  is  small. 

The  thermal  properties  of  the  arm  should  be  considered 
in  any  serious  design  effort  since  changes  in  temperature  can  add  yet 
another  degree  of  uncertainty  to  the  structure.  Significant  heat  sources 
can  be  realized  in  electric  and  hydraulic  actuators  under  high  cyclic 
loading  conditions. 

Low  coefficient  of  thermal  expansion  should  be  a desirable 
property.  For  our  90  cm  arm  made  out  of,  say,  aluminum  alloy,  a 
50  C range  cf  uniform  arm  temperature  results  in  a 3 /4  mm  length 
change.  More  significantly,  non-uniform  heating  of  the  members  can 
cause  greater  distortions  over  smaller  temperature  changes. 

The  material  finally  selected  is  steel  for  all  load-carrying 
members,  owing  to  its  cost,  ease  of  fabrication,  and  stiffness.  The 
thin  wall  sections  possible  with  steel  allow  potentially  greater  design 
freedom  for  internal  components:  valves  and  plumbing.  For  non-load- 
bearing  parts,  aluminum  or  brass  (for  fittings)  will  be  used. 
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b.  Structure  Design 

To  meet  the  30  Hz  resonance  requirement,  assumptions 
were  made  concerning  mass  distribution  and  end-point  loading.  Figure 
VII-4  illustrates  these  assumptions.  The  inertia  seen  from  the  shoulder 
(with  the  91  nt  (20  #]  load)  is  approximately  21.4  Kg-m^  (184  in  # sec^). 
An  equivalent  inertia  can  be  modeled  as  a point  rra  ss  of  25.  5 Kg  (56.  1 #) 
at  the  wrist-point,  91  cm  (36  in)  from  the  shoulder.  This  point  mass 
approximation  is  actually  conservative  since  most  of  the  distributed  mass 
is  inboard  of  the  wrist-point. 

A 30  Hz  natural  frequency  (f^ ) is  predicted  from  a 
point  mass  load.  The  required  stiffness, 

K = = 900  nt/mm  (5030  #/ in) 

where  m = endpoint  mass 
and  co  = angular  frequency 

2 2 

With  no  load  present,  the  inertia  drops  to  11.1  Kg-m  (95  in  # sec  ), 
and  fn  = 42  Hz.  It  is  assumed  that  all  vibrational  energy  is  caused  by 
small  linear  motions  of  the  load.  This  value  of  K can  be  built-in  easily 
by  considering  an  equal-stifmess  model  of  the  arm  in  two  sections: 
upperarm  and  forearm  (Figure  VII-5). 


Consider  the  relation  between  deflexions  and  area- 

moments: 

Total  deflexion  = 6j_StIEAR  + ^2-SHEAR  + *°2-SHEAR 
+ *2 -MOMENT  + la2- MOMENT 
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If  we  let  each  section  of  the  beam  be  equally  stiff  with  respect  to  the 
wrist-point, 

‘2  ‘ 711 

Values  for  Ij  and  I ^ which  satisfy  the  overall  stiffness 
requirement  of  900  nt/mm  (5030  */in)  are 

Ij  = 26.  6 cm4  (0.  65  in4), 

and  Ig  = 187.  cm4  (4.55  in4). 

If  all  sections  of  the  arm  structure  meet  this  criterion,  we  are  assured 
adequate  stiffness  (in  that  bending  mode  at  least). 

An  analogous  criterion  for  torsional  stiffness  does  not 
exist,  since  arm  payloads  and  performance  have  not  been  defined  for 
rotational  (moment)  loads.  However,  one  case  can  be  analyzed:  when 
the  elbow  is  cocked  90°,  the  upper  arm  is  subject  to  a torsional  load 
caused  by  payload  and  arm  weight.  An  equivalent  torsional  stiffness  is 
now  calculated,  based  on  the  required  lateral  stiffness. 

When  the  elbow  is  bent  90°  and  a simple  load  is  applied 
to  the  wristpoint,  three  sources  of  deflextion  exist:  bending  of  the 
forearm,  bending  of  the  upper  arm,  and  torsion  of  the  upper  arm  due  to 
the  moment  loads  that  previously  applied  to  bending.  Since  the  upper 
arm  is  much  stiffer  than  the  forearm,  we  will  ignore  this  source  of 
deflexion.  The  stiffness  of  the  forearm  alone  is  just  twice  the  overall 
bending  stiffness  (since  the  deflexions  of  each  member  in  bending  were 
set  equal  to  each  other).  The  effective  lateral  stiffness  at  the  wristpoint 
due  to  torsional  rigidity  of  the  upperarm  is  just 

K = = 1800  nt/mm  (10.6  #/mil) 

We  can  solve  for  the  required  polar  moment  of  inertia  of  the  upper  arm 
like  so: 

I = K.X  = 252  cm4  (6.  15  in4) 

P * 

~TT 
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where  G = shear  modulus,  70GPa  (107  psi), 
and  i = upperarm  length  = forearm  length. 


For  reasonable  cross  sections,  1 1 + i thu<; 

P xx  vv* 

insuring  us  of  adequate  torsional  stiffness  if  the  lateral  criterion  is  met. 


An  additional  bending  mode  requires  treatment,  however, 
parallel  bending  of  yoke-type  elements  pictured  in  Figure  Vll-6. 

These  elements  appear  at  every  joint  except  azimuth  and  wrist  roll  (joints 
1 and  4,  counting  from  the  shoulder).  While  these  elements  are  stiff  with 
r.-spect  to  lateral  bending,  they  are  not  necessarily  adequate  in  parallel 
bending.  To  assure  sufficient  stiffness  we  require  that  the  sum  of  the 
parallel  compliance  and  lateral  compliance  of  the  separate  sections  be 
less  than  or  equal  to  the  required  lateral  compliance  assumed  adequate: 


ytl*  yl  f Y1 


or 


TEI  TET"  + 


3 v3 

2tET7 


*i  ^ i y 
^ 


8(y°  - 3/.v^  + 3 1 2 v ) 


where  l = total  beam  length,  forearm  or  upperarm 
y = yoke  length 

I - sufficient  lateral  area-moment 

tj  - required  parallel  area-moment  of  one  yoke  side 
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LATERAL  BENDING 


PARALLEL  BENDING 


Figure  Vll-6 

Lateral  and  Parallel  Bending  Modes  of  Yokes 


1 

* 


i 


6 


A similar  expression  can  be  derived  for  sections  with  more  than  one 
yoke . 


For  the  dimensions  typical  of  this  arm, 

Ij  « 1/150, 

and  this  requirement  is  easily  met  by  the  designer. 

In  addition  to  the  above,  the  torsional  stiffness  of  the  yokes 
must  be  checked  against  that  derived  for  the  upper  arm  member. 

Referring  to  figure  VII-  7 , torsion  of  a yoke  may  be  divided  into  axial 
twist  along  each  ear  plus  bending  along  its  "stiff"  axis,  thus: 

Kts  Kr2 

r = radial  distance  to  ear  centrode,  since  the  ears  are  relatively  weak 
in  axial  twist.  To  obtain  an  adequate  Kt  as  noted  above,  r2^  51  mm  (2  in). 
For  all  proposed  yokes,  this  condition  is  automatically  met. 

c.  Support  & Worktable 

In  the  section  on  Configuration"  (IV  B)  an  over-the-work  type 
mounting  arrangement  was  indicated.  A straightforward  support  for  the 
arm  was  designed  as  shown  in  Figure  IV-  8 . The  rigidity  of  the  members 
was  determined  by  the  > 30  Hz  vibration  criterion,  and  the  assumption 
that  the  support  should  be  "overbuilt"  in  that  respect. 

The  inertial  load  seen  by  the  horizontal  members  is 
approximately  750  in#sec2;  for  a 100  Hz  fn,  a stiffness,  hy  of  3 x 108  in*/rad 
is  indicated.  Since 

1 = v ' 

TE" 

4 

we  require  an  area  moment  of  at  least  80  in  . This  is  easily  obtained  with 
a 10  square  by  1/2"  wall  welded  steel  box  beam. 
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Similarly,  the  load  seen  by  the  vertical  member  (in 
bending)  is  approximately  5300  m#sec2,  where  at  100  Hz,  K{  = 21  x 108 
in# /rad.  Thus,  I must  be  at  least  150  in4.  This  is  easily  obtained  with 
a 12"  square  x 1/2"  wall  box  beam. 

Checking  the  torsional  loading,  the  inertia  seen  by  the 
vertical  member  » 810  in#sec2.  Over  a length  of  60",  a stiffness  of 
about  2 x 10  in# /radian  is  present,  thus  making  con  = 500  rad/sec,  or 
about  80  Hz.  It  is  important  for  the  users  to  consider  (1)  additional 
loads  that  the  vertical  beam  will  see  in  torsion,  (2)  resonant  length  of 
the  beam  caused  by  changes  in  mounting  distance. 

The  worktable  upon  which  the  support  is  mounted  may 
also  be  a significant  source  of  compliance.  As  originally  ordered,  the 
table  consisted  of  a 48"  x 60"  x 1"  steel  plate  supported  in  a thin  (1  /4" 
thick)  sheet  steel  frame.  The  inertial  load  seen  at  the  base  of  the  upright 
column  is  approximately  3400  in#ser2  without  the  arm  present. 

The  frame  contributed  little  stiffness  to  the  ensemble  and  thus 

several  bending  (vibrational)  modes  of  the  table  top  (due  to  the  mounted  support) 
were  observed: 

(1)  Bending,  lateral  axis;  Kx  = 4 x 108 

in# /rad,  I = 4 in4,  f = 10  H . 

n z 

(2)  Bending,  longitudinal  axis;  K = 15  x 106 

in# /rad,  I = 5 in4,  f = 10  Hz. 
yy  n 

(3)  Torsion,  longitudinal  axis;  = 2.6x  10fi 

in# /rad,  f n = 4 Hz,  applicable  only  if 
table  lifts  off  floor. 

Additional  stiffeners  have  been  designed,  and  once  installed 
(under  the  table -top)  the  lateral  and  longitudinal  frequencies  will  each  be 
up  to  about  100  Hz. 
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d.  Shafts  & Couplings 

Throughout  the  discussion  on  stiffness  and  natural 
frequency  so  far  we  have  been  considering  the  "locked  joint"  compliances. 
This  is  an  idealization  based  on  the  design  of  servo  controls  for  the 
system.  More  precisely,  the  term  "locked  joint  compliance"  refers  to 
non-instrumented  compliances:  those  not  measurable  by  the  angle 

readout  sensors.  To  illustrate  several  of  these  we  will  consider  a 
typical  actuator  assembly.  Figure  VT1-8. 

Readout  sensors  (pancake  resolvers  in  this  case)  are 
mounted  concentrically  about  the  actuator  shaft;  they  are  denoted  "S" 
for  stator,  "R"  for  rotor.  A yoke  is  coupled  to  the  protruding  ends  of 
the  shaft,  while  the  motor  case  is  mounted  to  an  arm  member.  Under 
loading,  the  resolver  will  read  the  shaft  angle,  but  this  will  differ  from 
the  yoke  angle  by  the  small  twist  due  to  windup  of  the  shaft  between  the 
yoke  and  rotor.  In  terms  of  the  compliances  we  have  been  considering, 

we  require  that  the  shaft  windup  be  small  compared  to  arm  deflexions, 
or: 

777 r <<: 

P Kr 

where  I = polar  moment  of  inertia  of  shaft 

f r length  of  shaft  between  yoke  and  rotor 
G = shear  modulus 
K = required  arm  stiffness,  # /in 
r - distance  from  shaft  to  wristpcint 

For  the  elbow  actuator, 

Y~ « 12.4  in ^ 

P 

The  actuator  features  lp  « 0.2  in4,  and  / * 0.2  in;  thus, 
lp/l  « 1,  and  the  constraint  is  reasonably  well  satisfied.  Similar 
requirements  exist  at  the  other  joints,  and  the  shaft  sizes  and  mounting 
distances  reflect  this. 
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Other  compliances  exist  beyond  the  scope  of  measurement 
by  the  resolvers,  e.g.,  axial  and  radial  bearing  compliance.  Choice  of 
bearings  effects  overall  stiffness  considerably,  and  the  ideal  5000#/in 
figure  will  be  degraded  to  some  extent.  An  analysis  of  this  situation 
revealed  that  the  bearings  chosen  (practically  the  largest  possible  given 
the  present  actuator  design)  contribute  large  concentrated  compliances. 
The  overall  effect  can  be  (very)  conservatively  estimated  by  summing  the 
compliances  of  each  bearing  set  and  the  structural  compliance.  The 
result  indicates  a natural  frequency  of  about  19  Hz,  when  the  arm  is 
loaded  with  9.  1 Kg  (20  #).  Unloaded,  the  estimate  is  27  Hz. 

A more  detailed  treatment  of  this  problem  appears  in 
Section  III  of  Ref.  ( 2 ). 

Several  requirements  were  enumerated  for  the  shaft 
couplings  that  tie  the  actuators  to  the  arm  members: 

(1)  must  transmit  required  torque  safely 

(2)  must  have  short  axial  dimension 

(3)  must  be  rigid 

(4)  should  be  easily  installed,  aligned, 
disassembled 

Tapers,  press-fit  splines,  expanding  keys  and  other 
possibilities  were  investigated.  The  device  adopted  was  an  expandable 
locking  ring  assembly  manufactured  in  a wide  range  of  standard  sizes. 
(Figure  VII-9). 
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Figure  VII -0 

RINGFEDEI^®  System  LOCKING  ASSEMHI  IKS 


C.  Sensors 


1.  Angle  Sensors 

The  position  of  the  assembler  arm  is  determined  by  the  measurement 
of  the  six  joint  angles  and  a '.nowledge  of  the  geometry  of  the  arm.  The 
measurement  devices  that  were  chosen  are  dual  speed  resolvers.  The 
decision  to  use  resolvers  was  made  after  comparisons  with  other  kinds  of 
angle  sensors,  including  potentiometers  and  optical  encoders. 

Among  the  criteria  considered  were: 

1 6 

Accuracy  - 1 part  in  2 desired  (20  arc  seconds) 

Resolution  - could  motions  smaller  than  1/2 1 6 be  detected? 
Analog  or  Digital  Output 
Absolute  or  Incremental  Output 
Physical  Configuration 

Mechanical  Coupling  - no  form  of  gearing  was  considered 
acceptable 

Cost  and  Delivery 

Future  Technological  Prospects 

Slew  Speed 

Environmental  Sensitivity 

Potentiometers: 

Advantages 

Potentiometers  offer  the  advantages  of  low  cost,  availability, 
theoretically  unlimited  resolution,  and  convenient  interfacing  (requiring 
an  A/D  convertor). 

Disadvantages 

The  major  disadvantages  are  limited  life  due  to  contact  wear,  and 
an  accuracy  of  only  one  part  in  210  to  2 12  (10  to  12  binary  bits).  On  the 
basis  of  accuracy,  potentiometers  were  eliminated. 
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Absolute  Optical  Encoders: 


Advantages 

From  the  viewpoint  of  interfacing  to  a computer,  absolute  optical 
encoders  are  the  most  convenient  choice.  The  output  is  in  binary  form 
and  requires  the  simplest  of  interfaces.  Units  with  an  accuracy  of  .16  bits 
are  available. 


The  phvsical  configuration  is  awkward  to  use,  especially  at  the 
wrist  joints.  Typically,  such  encoders  are  cylindrical  with  a diameter 
of  about  3 , and  a length  of  more  than  5".  Another  negative  factor  is 
susceptibility  to  noise,  which  could  be  a severe  problem  in  an  industrial 
environment.  The  decisive  factor,  however,  which  eliminated  absolute 
optical  encoders  from  further  consideration,  was  their  prohibitive  cost. 
For  full  16  bit  encoders,  with  no  internal  mechanical  gearing,  the  price 
quoted  was  $5500  per  axis.  Furthermore,  it  does  not  appear  likely  that 
technological  improvements  will  lower  this  price  significantly  in  the 
future. 

Incremental  Optical  Encoders: 

Advantages 

Incremental  optical  encoders  offer  the  same  accuracy  as  absolute 
types  at  a fraction  of  their  cost  ($1600  for  a 16  bit  unit).  The  only 
conversion  electronics  necessary  are  Up/Down  counters  to  receive  the 
digital  output  pulses. 

Disadvantages 

As  with  the  absolute  type,  the  encoder  package  is  bulky.  Noise 
immunity  is  an  even  greater  problem.  Missed  count  pulses,  or  glitches 
causing  extra  pulses  cause  errors  that  carry  over  to  all  subsequent 
readings,  until  the  system  is  reinitialized.  Large  errors  can  quickly 
accumulate  in  this  manner.  A momentary  loss  of  power  results  in  total 
loss  of  angle  information,  which  could  be  catastrophic  in  this  application. 
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Resolvers : 


Advantages 

Resolvers,  like  potentiometers,  have  infinite  resolution.  Accuracy 
of  single  speed  units  is  limited  to  about  13  or  14  bits,  but  multispeed 
resolvers  (a  form  of  electrical  "gearing")  can  easily  obtain  accuracies  of 
16  bits  and  better.  Cost  is  generally  less  than  incremental  optical  encoders, 
especially  in  production  quantities.  Shaft  mounting  is  extremely 
convenient,  with  resolvers  that  come  in  the  "pancake"  type  package. 

The  technological  prospects  for  resolvers  are  also  very  good.  A 
recent  development  is  the  printed  pattern  resolver,  which  appears  to  be 
promising  for  multispeed  units.  Formerly,  printed  pattern  resolvers 
suffered  from  poor  transformation  ratios  - ratio  of  output  signal  to  input 
voltage.  Improvements  in  design,  however,  have  resulted  in  a very 
acceptable  ratio  of  .7/1.  The  advantages  of  printed  pattern  resolvers  are 
very  low  cost,  small  size,  and  the  possibility  of  making  the  resolver  an 
integral  part  of  the  actuator  shaft. 

Disadvantages 

Of  all  the  angle  sensors  considered,  resolvers  are  the  most 
difficult  to  interface  to  a computer.  Complex  convertors  are  needed  to 
derive  a digital  value  from  the  resolver  outputs.  The  cost  of  commercially 
available  convertors  can  exceed  the  cost  of  the  resolver.  Several  resolvers 
can  be  multiplexed  to  a single  convertor,  but  only  at  the  expense  of  the 
information  update  rate. 

An  additional  problem  with  mult  speed  resolvers  is  an  ambiguity  in 
tht  output.  A 64x  resolver,  for  example,  has  an  output  that  goes  through 
64  electrical  cycles  for  each  shaft  revolution.  A particular  output  can 
therefore  correspond  to  any  of  64  different  shaft  angles.  One  method  of 
resolving  this  ambiguity  is  to  count  the  cycles  as  the  shaft  rotates.  This 
is  essentially  an  incremental  method,  ard  suffers  from  some  of  the 
drawbacks  of  incremental  measurements.  More  reliable  is  the  addition 
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Of  a single  speed  resoiver  for  the  coarse  measurement,  leaving  fine 
measurement  to  the  mil, .speed  resolver.  The  penalty  of  this  method  is 
e extra  cost  for  the  additional  resolver  and  convertor  electronics. 

After  much  consideration  of  the  above  factors,  a decision  was 
reached  to  use  dual  speed  resolvers,  each  consisting  of  a single  speed  and 
a 64x  resolver  mounted  in  a single  pancake  shaped  package.  The  lx 
reso  ver  provides  the  6 most  significant  bits  of  angle  measurement,  while 

e 64x  unit  measures  an  additional  12  bits.  Of  the  total  18  bits.  If,  are 
read  by  the  computer. 

Each  resolver  has  a separate  resolver/digital  convertor,  allowing 
frequent  position  updates  and  the  tracking  of  high  speed  slewing  motions. 
The  convertors  are  not  commercial  units,  but  rather  a special  in  house 

' C°St  18  Under  ,10°  Per  aXis'  The  sbl  dual  aPeed  resolvers  are 

each  in  small  quantities.  This  would  drop  to  $450  each  in  lots  of  100. 

2.  Phase-Locked  Loop  Resolver  to  Digital  Convertor 

The  decision  to  use  dual  speed  resolvers  for  angular  measure- 
ment was  based  in  part  upon  the  ability  to  build  the  resolver  to  digUa 
convertors  in  house.  Commercially  available  convertors  are  generally 

c mp  e and  as  above.  _ _ ^ ^ 

nh  f ’ !'  1 7^  Lab0rat0ry>  howCTer'  research  and  development  in 

to  dili’t  , CirCU“ry  HaS  reSU“ed  in  ‘he  dcsi«n  °f  a PLL  resolver 

to  digua,  convertor.  This  convertor  circuit  is  simpler,  and  less  expensive 

conventional  methods,  and  will  often  have  better  performance. 

The  basic  operation  of  the  convertor  is  shown  in  Ptgure  V-i-10 
e inputs  are  the  resolver  modulated  signals,  cos  e cos  (wt)  and 
stn  6 I cos  (wt).  9 is  the  shaft  angle,  and  the  cos  (w„  carrier  term  is  the 
resolver  excitation,  a 1 kilohertz  sine  wave.  The  purpose  of  the  convertor 
to  generate  the  arc  tangent  of  the  ratio  of  the  two  inputs. 


0 = arc  tangent  f-s*n  0 c°s  wt  \ 
\cos  0 cos  wt  / 
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The  novel  feature  of  this  phase-locked  loop  circuit  is  the 
use  of  wo  Phase  detectors  and  two  feedback  ioops.  The  output  of  the 
Phase  detectors  is  the  product  of  their  inputs,  cos  (w.)  [cos  8 sinlwt-d, 
and  cos  (wtl  [sin  8 cos(wt-„)|.  These  are  summed  to  produce: 

1/2  sin(2wt+0-o)  + 1/2  sin(0-p) 

is  the  The  ?“er  PaSS6S  °nly  the  U-  C-  ,erm-  ‘/2  This 

frequency^  Th^"3  '°°P'  C°n'r°iS  ‘he  VCO  ou‘Pu>  Phase  and 

equeney.  The  servo  action  of  the  loop  drives  the  error  term  to  zero  by 

making  „ the  loop  phase  shift,  equal  to  8.  the  resolver  shaft  angle.  The 

online'  COnVerSi°n  °f ' * iS  the"  by  a standard  technique 

inserting  a counter  in  the  feedback  loop,  and  strobing  its  contents  into 

a register  when  the  reference,  cos(wt),  has  a phase  of  zero. 

By  including  an  integrator  in  the  filter  network,  a type  II 
servo  is  created.  This  enables  the  tracking  o,  both  constant  posi.Ls  and 
cons  ant  velocities  with  negligible  loop  error.  An  extra  bonus  is  the  fact 
that  the  loop  error  signal  is  proportional  to  de/dt.  making  it  equivalent  to 
tachometer  signal.  This  tach  signal  can  be  used  in  analog  compensation 
ne. works  for  controlling  the  hydraulic  actuators. 

One  feature  of  this  circuit  that  is  characteristic  of  all 
Phase-locked  loops  is  that  there  is  a filtering  effect  upon  the  signal. 

the  ■ HPa-H  n Slrable>  SinCe  il  reduces  ^e  level  of  noise.  The  narrower 

de  0;  H great6r  lHC  attenUa“°n-  TWS  ""*•  ‘»  a design 

rade-off,  however,  since  . wide  bandwjdth  „ ^ ^ 

IT  77  Thr°“gh  'eSting'  3 SUit3ble  value  was 

achieved.  The  convertor's  characteristics  are  similar  to  that  of  a second 

of  7 and  "I:  T,T’  WUh  3 breSk  freqUenCy  °f  ab°Ul  60  hertz'  damping 
• . a 40  db/decade  high  frequency  roll  off.  This  size  bandwidth  is 

Wide  compared  to  the  assembler's,  ye.  is  sufficiently  narrow  to  filter  ou 
most  noise. 

Bach  of  the  six  dual  speed  requires  two  PLL  convertors.  The 

“7  ; TTf  reS°1Ver  haS  3 12  b“  °UtPUt’  Whi'a  *>»  « “nit  produces 
bits,  of  which  the  least  significant  is  an  overlap  bit  for  the  MSB  of  the 

64X  section.  Additional  logic  combines  the  two  outputs  into  a single  18 

bit  word.  The  16  most  significant  of  these  are  available  to  the  computer. 


3.  Force  Sensors 

a.  System  Considerations 

One  device  which  ; being  studied  in  the  current  research 
is  a six  degree  of  freedom  force  sensor.  This  device  can  be  used  between 
the  arm  and  the  hand  of  a manipulator/assembler,  or  it  may  be  used  in  a 
pedestal  form  as  part  of  the  work  mounting.  The  following  analysis  covers 
some  of  the  general  considerations  of  the  use  of  this  type  of  device. 

General  Case 

Suppose  that  forces,  pressures,  and  moments  are 
applied  to  a rigid  body  mounted  on  a force  sensor.  This  corresponds  to 
the  case  of  a pedestal  force  sensor.  These  forces,  pressures,  and 
moments  can  be  summed  (or  integrated)  to  find  a resultant  applied  moment 
Ma  plus  a resultant  applied  force  Fa.  There  is  also  a gravitationally 
induced  force  mg,  acting  downward  and  located  at  the  center  of  mass: 


Figure  VII- 11 

Work  Object  Mounted 
on  a Force  Sensor 


Now  suppose  that  the  force  sensor  is  instrumented  in  a coordinate 
system,  xyz,  and  that  the  sensed  forces  anc;  moments  are  read  as  JPs  and 
Ms.  Also,  define  the  location  vector  of  the  center  of  mass  as  Reg,  and 
the  location  vector  of  the  resultant  applied  torce  as  Rf.  We  then  have: 

Fs  = mg  + Fa  VII-1 

and  Ms  = mg  X Reg  + Fa  X Rf  + Ma  VII-2 
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Obviously  the  vectors  in  VII- 1 and  V II - 2 have 

dimensionality  3. 

It  is  possible  to  evaluate  the  terms  in  nig,  by  letting 
F]a  and  \]a  go  to  zero.  This  corresponds  to  removing  the  arm  from 
contact  with  the  body.  We  then  have: 


Fs  --  mg_  VI 1-3 

^js  mg  ,\  Reg  V 11-4 

VII- 3 and  VII- 4 can  be  combined  into  VII- 1 and  VII-2  , moving  the 
known  quantities  to  the  right  hand  side  of  the  equations,  and  the  quantities 
to  be  determined  to  the  left.  The  result  is: 


Fa  - Fs  - mg 

and  Ma  Fa  X Rf  - .Vis  - mg  X Reg 

VII-5  and  VII-6  can  be  coordinatized  in  xyz  to  obtain 


~Max" 

May 

+ 

.Maz. 

Fax 

Fsx 

Fay 

Fsy 

Faz 

Fsz  - mg 

Y'II-5 

VII-6 


VII -7 


-Faz  Rfv  + Fay  Rfz 
Faz  Rfx  - Fax  Rfz 
L-Fay  Rfx  <-  Fax  Rfv 


Msx 

-mg  Rcgv' 

z 

Msy 

- 

mg  Rcgx 

- 

Msz. 

0 

VII-  8 

VII- 7 and  VII- 8 show  that  Fa  can  be  evaluated  in  all  cases.  However, 
Ma  cannot  be  evaluated  without  additional  information  since  Eq.  VII- 8 is 
insufficiently  specified.  We  can  substitute  the  three  components  of  Fa  as 
found  from  VII- 7 into  Eq.  VII-  8 , and  are  left  with  three  equations  in  six 
unknowns.  (The  unknowns  are  Max,  May,  Maz,  and  Rfx,  Rfy,  and  Rfz.  ) 

No  solution  can  be  obtained,  which  is  tantamount  to  saying  that  the  location 
of  the  applied  force  and  the  applied  moment  vector  are  both  indeterminate 
unless  additional  information  besides  the  output  of  the  force  sensor  is 
available.  Some  possible  cases  which  allow  a complete  solution  are: 
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Zero  Applied  Moment 


The  nature  of  the  contact  applied  to  the  body  ma\  be 
such  that  only  a force  is  induced.  In  this  case,  the  sensed  moment  arises 
from  the  applied  force.  In  this  case,  the  appropriate  equations  are: 


0 -Faz  Fay" 

■Rfx‘ 

Faz  0 -Fax 

Rfy 

.-Fay  Fax  0. 

_ Rfz 

Msx  - mg  Rcgy 
Msy  - mg  Rcgx 

0 

VII-9 


This  is  to  be  solved  for  the  Rf  vector,  but  the  coefficient  matrix  is 
singular.  However,  physical  consideration  shows  that  a line  on  which 
the  point  of  action  of  the  force  lies  can  be  determined,  since  the  moment 
and  the  force  are  both  known. 


Force  Application  Point  Known 


It  may  be  that  the  point  of  force  application  is  known, 
either  from  the  body /arm  geometry,  or  from  measurements  of  the  joint 
angles.  If  this  is  true,  it  is  possible  to  specify  something  about  both  the 
applied  force  and  the  applied  moment.  Under  these  conditions  the 
equations  become: 


’ Max " 

'known 

May 

= 

quantities 

_ Maz 

from  VII-8 

VII-10 


Response  to  Gravitation 

It  is  instructive  to  coordinatize  VII- 3 and  VII-  4 . The 

result  is 


"Fsx" 

' 0 ' 

Fsy 

= 

0 

_ Fsz_ 

.-mg. 

Msx" 

-mg  Rcgy' 

Msy 

r 

mg  Rcgx 

_Msz 

0 

VII-  11 


VII-  12 
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Note  that  no  information  is  given  about  Rcgz.  This  is  to  be  expected 
since  the  sensed  moment  is  indepet  dent  of  the  vertical  location. 

Conclusion 


The  above  equations  indicate  the  amount  of  information 
available  from  a force  sensor.  The  analysis  is  similar,  independent  of 
whether  the  sensor  is  mounted  on  a pedestal  or  on  a wrist,  but  the 


coordinatization  and  the  orientation  of  the  mg  term  are  differen,  in  the 
two  cases.  It  is  also  true  that  in  the  case  of  the  wrist  sensor,  in  general 
the  application  point  is  on  or  near  the  z axis  of  the  sensor,  with  correspond 
mg  effects  onthe  components  which  appear  in  the  equations.  However,  in 
the  wrist  case,  the  orientation  of  the  mg  vector  is  arbitrary,  as  contrasted 

with  the  pedestal  case,  in  which  the  orientation  of  the  mg  vector  is  known 
to  be  in  the  sensor  z direction. 


b.  Arm  Force  Sensing  by  Joint  Torque  Measurement 

Description  of  the  Method 

If  the  torques  in  the  arm  joints  can  be  sensed,  it  is 
possible  to  calculate  the  hand  contact  forces  using  the  analysis  in  the 
following  sections.  The  advantage  of  doing  this  is  that  the  necessity  for 
a separate  sensor  no  longer  exists,  and  the  cost  and  space  requirements 
are  saved.  The  disadvantage  is  that  the  available  sensitivity  may  be  less, 
since  the  desired  forces  have  to  be  separated  from  the  friction  forces 
which  are  unwanted.  In  order  to  perform  this  separation,  the  desired 
forces  should  be  sufficiently  large  to  permit  easy  separation.  The  exact 
force  levels  which  can  be  measured  in  this  system  will  have  to  be 
determined  by  experiments,  but  it  may  be  possible  to  make  a partial 
analytic  prediction.  The  joint  torque  system  is  especially  adapted  to 
the  Draper  Laboratory  arm,  because  the  Draper  Lab  arm  is  designed  to 
use  low  friction  hydraulic  actuators,  since  the  vane  motors  are  designed 
to  be  used  with  non-contacting  vanes,  permitting  a flight  leakage  between 
the  vanes  and  the  housings.  Under  these  conditions,  the  torque  developed 
is  given  quite  closely  by  the  pressure  differential  between  the  two  sides  of 
the  vane.  It  is  then  possible  to  measure  the  forces/torques  developed  on 
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the  work  by  the  following  analysis. 


Calculation  of  the  Hand  Forces 

The  problem  is  the  determination  of  an  arm  joint 
torque  vector  which  will  give  rise  to  a specified  force  (and  torque) 
vector  at  the  hand.  A simple  and  direct  derivation  follows:  Let  dx 
be  a small  motion  of  the  hand,  expressed  in  hand  coordinates,  d0  the 
corresponding  joint  motions,  and_J  the  Jacobian  matrix  of  the  arm.  If 
the  arm  structure  is  sufficiently  stiff,  then 

dx  - J dQ  VII-  13 

If  this  displacement  is  the  result  of  a force  vector 
applied  to  the  hand,  the  energy  developed  must  go  into  the  joint  drivers, 
thus: 

f^Jde  = T td0  V 11-14 

Since  the  angular  displacement  vector  dQ  is  independent,  it  follows  that 

fl  j = j1  VII- 15 

which  can  be  transposed  to 

l --  T VII-16 

the  desired  result. 

Note  that  the  present  derivation  implies  linearity.  This 
means  that  it  can  only  be  applied  if  the  arm  stiffness  is  sufficiently  great 
that  J is  essentially  constant  under  the  application  of  the  force  and  torque 
vectors  _f  and  T. 

Now  suppose  that  the  arm  joints  are  instrumented  to 
read  their  torques  as  vector  T.  In  the  case  of  hydraulic  actuators,  the 
torque  can  be  measured  as  a pressure  difference,  while  in  the  case  of 
electric  motors,  the  torque  may  be  measured  as  a current.  Then,  con- 
sidering equation  VII- 15  we  can  postmultiply  by_J  to  obtain  the  applied 
force 

ft  = Tt  j"1  VII-17 


See  Ref.  8. 
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J IS  available  since  it  is  computed  to  obtain  desired 
effects  in  hand  coordinates.  Since  T is  hypothesized  to  be  instrumented 
the  simple  multiplication  in  VII- 17  is  all  that  is  requlred  to  obtaln  ,he 

desired  force  vector.  Also  note  that  if  T is  contaminated  by  an  error 
— t the  corresponding  error  in  the  computed  force  is  given  by 


In  the  presence  of  gravity,  the  above  equations  apply  to 
deviations  from  the  nominal  forces  and  torques  due  to  gravity. 

Engineering  Considerations 

if  pressure  sensors  are  applied  to  the  two  sides  of  a 
vane-type  or  other  hydraulic  actuator,  it  is  possible  to  define  the  torque 


Errors  in  the  torques  are  primarily  caused  by  errors 
in  the  pressure  sensors,  and  also  by  friction  in  the  joint.  The  joint 
friction  can  be  resolved  into  components  proportional  to  the  various  force 
components  applied  to  the  joints,  plus  any  stick  effects  which  may  coexist. 

A friction  coefficient  matrix  for  any  actual  proposed  joint 
can  be  measured  or  calculated  from  specs.  Once  this  matrix  is  known 
it  is  simple  to  predict  the  expected  error  in  the  force. 

It  appears  obvious  that  a rea-onably  good  force  measure- 
ment is  available  without  any  instrumentation.  In  any  event  it  is  easy  to 
test  this  proposal  since  only  the  relevant  software  need  be  generated,  and 
the  force  calculation  may  be  tested  by  applying  known  forces  to  the  hand 
and  comparing  the  calculated  forces  as  derived  from  the  pressure  sensors. 
This  may  be  expressed  conveniently  as  the  relevant  error  ellipsoid. 

c.  Pedestal  Force  Sensors* 


» Summary  of  work  sponsored  by  NSP  grant  no.  ATA74-18173  A01. 


125 


A Strain  Gauge  Pedestal  Force  Sensor 


A strain  fiance  type  pedestal  force  sensor  has  been 
designed  and  is  currently  under  construction.  The  general  layout  of  this 
design  is  shown  in  h igure  \ 11-12.  This  is  a three  layer  design  adapted 
from  the  wrist  force  sensor  concept  previously  described.  The*  sensing 
elements  are  to  consist  of  load  beams,  assuming  satisfactory  performance 
of  the  sample  load  beam  which  is  currently  being  awaited. 

A BLH  product  exists  which  has  capacities  directly 
applicable  to  some  of  our  sensor  problems.  This  is  called  a load  beam, 
and  is  a beam  and  strain  gauge  assembly.  The  attached  data  sheet  shows 
some  of  its  features.  Sheets  are  also  attached  describing  platform 
transducers,  which  illustrate  technology  directly  applicable  to  some  of 
the  force  components  to  be  sensed.  (Tables  VII-1,  2) 

A Laser  Pedestal  Force  Sensor 

The  sensor  structure  of  c is  to  be  designed  to  accept 
laser  instrumentation  as  soon  as  this  becomes  available.  In  order  to 
expedite  the  actual  construction,  it  is  proposed  to  order  two  sets  of 
structural  components,  one  of  which  will  be  instrumented  with  strain 
gauges,  and  the  other  with  the  laser  system. 

d.  Wrist  Force  Sensors 

Draper  Arm  Wrist  Force  Sensors 

A preliminary  structural  concept  of  this  sensor  has 
been  devised  and  is  shown  in  Figure  VII -13.  This  design  can  also  be 
instrumented  with  either  laser  displacement  detectors  or  strain  gauges. 

e.  Laser  Force  Sensor  Specifications 

The  current  specifications  are  shown  in  Table  VII-3 
for  the  Draper  Arm  Wrist  Force  Sensor.  Figures  VII-14  and  VII-15 
use  sin  and  cos  functions,  to  avoid  the  discontinuities  which  might  be 
encountered  if  an  attempt  were  made  to  use  the  arc  tangent  function. 

The  functions  are  guaranteed  to  be  well  behaved,  and  to  be  monotonic 
under  the  presence  of  a certain  amount  of  distortion  in  the  input  waves. 
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LOAD  SEAM 


50 -TO  7500 


TYPE  LBP1 


OY\ft  i 


PRECISION  ACCURACY 

RESISTS  SIDE,  ECCENTRIC  AND 
THRUST  LOADS 


LOW  PROFILE 

ADAPTABLE  TO  A WIDE  VARIETY  OF 
APPLICATIONS,  INCLUDING  ON-LINE 
PROCESS  WEIGHING 


* 


”L"  brackets  convert  LBP1  to  low-cost 
load  cell. 


Internal  view  of  platform  scale  built  with 
LBP1  transducers  clearly  illustrates  clean 
design  and  total  absence  of  moving  part’ 


SUGGESTED  METHOD  OF  INSTALLATION 


SUPPORTING  FRAME 

/ 

L BP 1 LOAD  BEAM 


SHOCK  MOUNT 


WEIGHBRIDGE 


LIMIT  STOP 


PROTECTIVE  BELLOWS 


Table  VII- 1 


DUND  CAPACITY 


LOAD  BEAM 


SPECIFICATIONS 


Performance 


CAPACITY: 

SO  to  5000  pounds 

RATED  OUTPUT: 

2 mV/V 

CALIBRATION 

ACCURACY: 

0 25'.  II  required,  0.10% 
of  Rated  Output. 

NONLINEARITY: 

0.03%  R.O. 

HYSTERESIS: 

0.02%  R.O. 

REPEATABILITY: 

0.01%  R.O. 

OVERLOAD 

CAPACITY: 

200%  R.O. 

APPROXIMATE 

OEFLECTION: 

.010  lo  .040  inches 
depending  on  capacity. 
Highest  deflection  for 
higher  capacity  units. 

CREEP: 

Less  than  0.01%  in  15 
minutes.  This  is  an 
asymptotic  value  (greater 
than  90%  of  final  value.) 

UNIVERSAL  LOAD 
EFFECT  (TOGGLE) : 

Le:  s than  0.03%  R.O. 
zerc  shift  with  full  load 
reversal. 

MAXIMUM  THRUST 
WITHOUT  FAILURE 

100%  of  capacity. 

MAXIMUM  SIDE  LOAD 
WITHOUT  FAILURE: 

50%  ol  rapacity. 

ECCENTRIC  LOAD 
EFFECTS: 


a.  Axial  Direction 

Less  then  0.05%  change 
in  span  with  50%  change 
in  moment  arm. 

b.  Lateral  Direction 

Less  than  0.1%  charge 
with  1/8  inch  to  1/4  inch 
off-center  load.  Distance 
proportional  to  capacity. 

Electrical 

TERMINAL  RESISTANCE: 

Input  375  : 1 5 ohms. 

Output  350  • 5 ohms. 

BRIDGE  CIRCUIT 
SYMMETRY: 

Within  2 ohms. 

EXCITATION  VOLTAGE 

15  volts  maximum 

APPROXIMATE  NATURAL 
FREQUENCY: 

350  to  500  cps 

ELECTRICAL 

CONNECTION: 

5 ft.  cable. 

Environmental 

SAFE  TEMPERATURE 
RANGE: 

1 5°F  .o  11  5°F 

TEMPERATURE  EFFECT 
ON  ZERO  BALANCE: 

Less  than  :.G015%  R.O  ''f . 

TEMPERATURE  EFFECT 
ON  SPAN 

Less  than  - .0008’:  R.O./°r 

BAROMETRIC  EFFECT: 

None. 

ELECTRICAL  TERMINATION 
CABLE  COLOR  CODE 
INPUT  OUTPUT 

Black  (-)  Red  (-) 

Green  ( t-)  White  (a-) 


CAPACITY 
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Table  VII-2 


33 


• MOUNTING 


f.  Other  Sensors 


Consideration  is  being  given  to  the  incorporation  of 
proximity  sensors  as  a fault  hazard  avoidance  device.  These  sensors 
would  shut  down  the  arm  motion  in  case  any  obstacle /object  was  detected 
in  a location  not  expected  by  the  computer. 
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D.  Hydraulic  Control 


1.  Introduction 

ck°*ce  of  hydraulic  actuators  for  the  manipulator  brings 
with  it  a particular  set  of  control  problems  that  must  be  dealt  with  by  the 
hydraulic  control  system.  This  system  must  take  commands  issued  by 
the  computer  and  then  control  the  actuators  to  produce  the  desired  perform- 
ance. The  problems  that  complicate  the  job  of  the  hydraulic  servo  include 
the  non-linear  behavior  of  certain  hydraulic  elements,  compliance  of  the 
hydraulic  fluid,  and  the  dynamic  effects  of  several  components  in  the  control 
loop.  The  desired  performance  of  the  control  system  includes  basic 
stability,  smooth  motions  of  the  manipulator  structure,  and  graceful 
failure  of  the  control  system  should  the  computer  fail  to  function  properly. 

2.  Analytical  Development 

The  overall  plan  of  analysis  began  with  formulation  of  the 
non-linear  equations  of  motion  of  the  system  consisting  of  the  hydraulic 
actuator  and  load.  Then  a computer  program  to  simulate  this  system  was 
written  and  debugged.  Next,  hydraulic  control  systems  we.-e  formulated 
and  added  to  the  basic  simulation.  The  performance  of  the  combined 
system  was  then  tested  through  simulation.  Usually,  in  order  to  design 
the  various  control  systems  a simplified,  linearized  form  of  the  non- 
linear hydraulic  equations  was  assumed  for  the  purpose  of  analysis.  The 
resulting  designs  were  then  tried  on  the  simulated  non-linear  system. 

in  the  modeling  process  decisions  had  to  be  made  concerning 
which  effects  or  properties  were  sufficiently  important  to  include  in  the 

system  model  and  which  were  not.  The  following  are  effects  that  were 
included: 

a.  Fluid  compliance  in  the  chambers  or.  both 
sides  of  the  hydraulic  actuator  vane. 

b.  Non-linear  valve  characteristics. 

c.  Fluid  viscosity  in  che  actuator  leakage 
from  one  side  of  the  vane  to  the  other. 
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d.  Hydraulic  valve  dynamics  between  the 
input  electric  current  and  the  valve 
opening  size. 

e.  Inertial  load  on  the  actuator. 

f.  Dynamic  effects  of  the  angle  reading 
resolver  circuitry. 

Among  the  effects  not  included  were  the  following: 

a.  Inertial  effects  of  the  fluid  between  the 
valve  and  the  actuator.  These  effects 
should  be  small  because  the  valves  are 
mounted  on  the  actuators  and  so  the 
relevant  fluid  mass  is  small. 

b.  Inertial  effects  of  the  fluid  between  the 
pump  accumulator  and  the  valve.  These 
effects  should  be  small  because  of  the 
sufficiently  large  diameter  of  the  hose 
which  causes  slower  fluid  velocities. 

c.  Friction  in  the  actuator.  Friction  is 
designed  to  be  minimized  by  the  lack  of 
seals  between  the  vane  and  the  outer 
wall  of  these  actuators.  Hence,  there  is 
no  rubbing  contact.  The  only  friction 
should  be  the  low  friction  in  the  shaft 
bearings. 

The  non-linear  model  of  the  hydraulic  system  with  inertial 
load  is  illustrated  in  Figure  VII-16.  Table  VII- 4 is  a list  of  variable 
definitions  used  in  the  formulation.  The  derivation  of  the  equations  is 
carried  out  in  Appendix  II  . The  final  non-linear  equations  are  repeated 


136 


Table  VII-4  Variable  Definitions 


e 


oo 

P 

s 


v1sV1(e) 

v2-v2(e) 

**1 


^2 

D 

q 

V 

p 

C^Vj/0 

<VV3 


x 


s 


I 


angular  position  of  vane,  rad 
angular  rate  of  vane,  rad/sec 
supply  pressure,  psi 

exhaust  pressure,  psi 

pressure  in  left  actuator  chamber,  psi 

pressure  in  right  actuator  chamber,  psi 

3 

volume  of  left  chamber,  in 

3 

volume  of  right  chamber,  in 

flow  through  left  orifice,  cis(=  in'  /sec) 

flow  through  right  orifice,  cis 

displacement  of  vane  rotation,  in3 /rad 
leakage  flow  past  vane,  cis 

"flow"  due  to  displacement  of  actuator  vane,  cis 

effective  bulk  modulus  of  fluid,  psi 

3 

fluid  capacitance  of  volume  Vj,  in  /psi 

3 

fluid  capacitance  of  volume  Vg,  in  /psi 

pressure  upstream  of  orifice  1 on  left,  psi(=  Pg 

pressure  downstream  of  orifice  2 on  righf, 
psi<=  PE  or  ps> 

valve  spool  position 

2 

inertia  of  load,  in-lbf-sec 


here. 
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VII-20 


VII-21 


The  first  of  equations  VII-20  expresses  the  rate  of  change  of 
pressure  in  the  left  hand  chamber  of  the  actuator  in  Figure  VII-16  as  the 
sum  of  the  flows  into  the  chamber  divided  by  the  capacitance  (compliance) 
CjfQ)  of  the  total  fluid  in  the  chamber.  As  indicated  in  Table  VII-4  , this 
compliance  is  a function  of  the  fluid  modulus  0 and  the  volume  of  the  fluid 
r hamber,  which  itself  is  a function  of  angular  position  0-  The  second 
equation  is  like  the  first  but  for  the  other  fluid  chamber.  The  third  equation 
is  Newton's  equation  for  a rotary  load,  and  the  last  equation  just  defines 

angular  rate  aj.  The  function  fq  (•  , •)  is  short  hand  for  the  quadratic  flow 
function  of  an  orifice: 

q = VXs*  AP)  =(  KVXs  for  AP  > 

VKvxs  J\Kp\\  for  AP< 


0 

VII-22 

0 


where 


AP  = pressure  drop  across  orifice 
xg  = valve  spool  position 
Ky  = valve  orifice  gain 
q = flow  through  orifice 
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For  a single  orifice  x^  is  considered  only  positive  or  zero. 
Hence,  the  flow  through  the  orifice  as  defined  by  the  above  function  is 
always  in  the  direction  of  the  pressure  drop.  In  a standard  fourway 
hydraulic  valve  a negative  spool  position  corresponds  to  a reversal  of  the 
connections  of  supply  pressure  and  exhaust  pressure  to  the  hydraulic 
actuator.  This  is  so  actuators  may  be  driven  in  both  directions.  This  switch 
in  supply  and  exhaust  pressure  is  the  purpose  of  equations  (Vll-21 ) since 
they  define  which  orifice  is  connected  to  exhaust  and  which  to  supply. 

The  non-linear  equations  (V1I-20)  were  implemented  in  the 
computer  program  that  was  used  in  subsequent  simulation  testing.  For 
the  purpose  of  ease  of  analysis,  however,  it  is  useful  to  simplify  these 
equations  as  much  as  possible.  The  following  assumptions  were  used  to 
make  these  simplifications: 

a.  Cj(fl)  = CgfQ)  - C;  that  is,  that  the  fluid 
capacitance  is  relatively  constant  and 
equal  on  both  sides  of  the  vane.  This 
means  that  the  vane  is  assumed  to 
remain  essentially  near  the  center  of  its 
range  of  motion. 

b.  We  assume  linearization  of  the  flow 
functions  f for  the  valve  orifices  as 
follows: 

Vv  AP>-  % * ks<vxSo> + kP<Ap-APo)  v“-23 

where  xgo  = valve  spool  linearization  position 

APq  = pressure  drop  linearization  value 

kg  = spool  position  gain  = afq/5xs 

k = pressure  drop  gain  = fcf  /gAP 
• q 

c.  We  further  assume  that  the  pressure 
drop  across  both  orifices  in  the  valve  is 
about  the  same,  i.  e. , both  APq^  Pg/2, 
assuming  exhaust  pressure  P„  = 0.  These 
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assumptions  combine  to  make  approximately 
equal  for  both  orifices. 

d.  Assume  that  xgQ  = 0.  This  means  that  the 

valve  is  operating  about  its  closed  position 

and  furthei  implies  that  q =0  and  k - 0. 

o p 

e.  Assume  that  kg  is  the  same  for  both  orifice*? 
This  is  a safe  assumption  because  hydra Jlic 
servo  valves  are  almost  invariably  designed 
with  matched  orifices. 


Working  with  these  assumptions  as  shown  in  Appendix  II 
gives  us  the  following  simplified,  linearized  equations: 


AP  = P2 
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Figure  VII- 17  shows  these  equations  in 
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block  diagram  form. 


3.  Modeling  Types  of  Hydraulic  Control  Systems 


The  purpose  of  the  hydraulic  control  system  is  to  convert 
the  commands  from  the  computer  into  the  desired  actions  of  the  arm  and 
load.  This  control  system  will  physically  reside  in  the  interface  equipment 
connected  between  the  computer  and  the  manipulator.  Digital  words 
corresponding  to  computer  commands  will  be  fed  into  the  interface  f"om 
the  computer.  The  output  of  the  interface  is  a properly  modulated  wfialog 
electric  current  which  will  control  the  valve  orifice  openings.  Actually, 
since  there  will  be  six  hydraulic  actuators  to  control,  there  will  be  six 
such  hydraulic  control  circuits  in  the  system  interface. 
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Figure  VI 1-1  7 

I. inear-  Simplified  Hydraulic  I.oad  Model 
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Tne  hydraulic  control  circuits  must  still  function  if  the 
computer  does  not.  This  is  the  concept  of  "graceful  failure":  the 
computer  must  not  be  so  vital  to  the  operation  of  the  system  that  it  goes 
unstable  if  the  computer  icTls  or  if  there  is  a program  error  and  t :e 
computer  stops.  This  will  put  requirements  on  the  control  system 
configuration.  The  criteria  by  which  the  control  system  is  judged  are  that 
the  performance  of  the  manipulator  must  be  stable,  smooth,  and  sufficently 
fast. 

The  control  system  design  process  will  be  to  use  the 
simplified  linear  model  of  the  hydraulic  and  load  system  to  design 
alternative  control  systems.  These  alternative  control  designs  will  be 
tested  by  simulating  them  with  the  non-linear  hydraulic  simulation.  There 
are  four  types  of  control  systems  tested: 

a.  Pure  position  feedback 

b.  Position  feedback  with  rate  feedback 

c.  Position  feedback  with  lead  filter  on 
rate  feedback 

d.  Position  feedback,  rate  feedback,  and 
actuator  load  pressure  feedback 

The  simulated  system  includes  additional  effects  that  will 
not  be  used  in  the  simplified  analysis.  For  example,  the  simulated 
hydraulic  control  system  includes  the  dynamic  effects  of  the  hydraulic 
valve  and  the  angle  reading  resolver  circuitry.  The  bandwidth^  of  both 
of  these  components  are  well  above  the  hydraulic  resonance  frequency 
and  so  were  excluded  from  the  simplified  analysis. 

a.  Position  error  control 

Position  error  control  is  illustrated  in  Figure  VII- 18  by 
a block  diagram.  The  basic  idea  here  is  that  the  electric  current  through 
the  hydraulic  valve  is  made  proportional  to  the  error  between  desired 
position  and  actual  position.  A root  locus  diagram  for  this  system, 
assuming  the  simplified  linear  equations,  is  also  shown  in  Figure  VII- 18. 


The  locus  of  the  poles  of  the  closed  loop  system  is  shown  for  increasing 
values  of  position  error  gain  K 

Notice  that  as  the  position  error  gain  K is  increased,  the 
pole  pair  associated  with  the  hydraulic/load  resonance  is  driven  unstable. 
Qualitatively  what  is  happening  is  the  following:  At  the  resonant  frequency 
of  any  complex  pole  pair,  their  phase  lag  is  90°.  The  integrator  in  the 
system  possesses  an  additional  90°  phase  lag.  Obviously,  these  two 
elements  together  in  the  open  loop  possess  a total  of  180°  phase  lag  at  the 
resonant  frequency  of  the  load  resonance  poles.  Consequently,  sufficient 
error  gain  will  simply  drive  the  system  unstable.  Also,  a look  at  the  root 
locus  shows  that  pure  position  error  control  will  not  damp  the  resonant 
poles.  Figure  VII-  19  shows  the  results  of  a simulation  of  pure  position 
feedback  on  the  non-linear  system  using  component  values  corresponding 

to  the  shoulder  actuator  of  the  manipulator  design.  Clearly  the  resonant 
poles  have  not  been  damped. 

Position  error  control  cannot  be  abandoned  completely. 
After  all,  to  control  the  manipulator  position  there  must  be  a position 
error  loop  somewhere  in  the  control  system.  And,  some  position  loop 
closure  must  occur  in  the  interface  to  insure  graceful  failure  when  the 
computer  is  not  functioning. 

b.  Position  and  rate  feedback 

The  addition  of  rate  feedback  is  a common  cure  for 
oscillatory  position  servo  systems.  Figure  VII-20  contains  a block 
diagram  of  the  system  with  the  additional  rate  feedback.  Also  shown  is 
a root  locus  diagram  showing  the  pole  motion  of  the  closed  rate  loop  system 
for  increasing  values  of  rate  feedback  gain  in  this  case  a particular 
value  of  position  error  gain  Kg  is  assumed  and  held  constant.  Hence, 
the  initial  pole  positions  in  the  root  locus  of  Figure  VII-20  correspond  to 
the  poles  for  a certain  value  of  position  error  feedback. 
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As  can  be  seen  from  the  root  locus  diagram,  as  the  rate 
feedback  gain  increases  the  frequency  of  the  resonant  poles  increases 
and  the  frequency,  or  speed,  of  the  dominant  real  pole  decreases.  This 
means  that  for  high  values  of  rate,  or  "tach",  feedback  the  overall 
system  performance  becomes  sluggish  (the  real  pole)  but  with  high 
frequency  ringing  overlaying  the  basic  response.  Figure  VI1-21  shows 
the  result  of  a simulation  of  the  step  response  of  a typical  system  with 
excessively  high  rate  feedback.  The  simulation  used  the  position  and 
rate  feedback  scheme  on  the  non-linear  model  of  the  hydraulics  and  load. 

c.  Position  feedback  with  lead  filter  on  rate  feedback 

The  high  frequency  ringing  apparent  in  the  previous 
section  occurs  because  at  the  frequency  of  the  ringing  the  total  phase  lag 
of  the  open  loop  system  is  almost  180°  with  nearly  too  much  gain.  One 
possible  way  to  eliminate  the  ringing  is  to  reduce  the  phase  lag  in  the  rate 
loop  at  that  frequency  by  introducing  a lead  filter. 

Alternatively,  one  can  imagine  the  ringing  problem  arising 
from  the  two  resonant  poles.  These  poles  occur  in  the  transfer  relationship 
between  hydraulic  valve  electric  current  (spool  position  xs)  and  0,  angular 
rate.  Since  the  output  variable  is  0,  rate  in  this  case,  the  poles  may  be 
damped  by  the  additic.i  of  feedback  of  the  output  derivative,  0,  or  accelera- 
tion. By  adding  lead  compensation  to  the  rate  feedback,  we  obtain  the 
effect  of  differentiation,  resulting  in  an  acceleration  feedback  signal. 

A block  diagram  of  this  control  scheme  is  shown  in 
Figure  VII-22.  The  form  of  the  lead  compensation  is 

1 + s/wd 

1 + s /to 
g 

where  ood  = lead  frequency,  rad /sec 

GUg  = lag  frequency,  rad/sec 

oo . <oo 
d g 
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Figure  \ 1 1-22 
Block  Diagram 

Position  Feedback  with  Lead  Filter  on  Hate  Feedback 


For  frequencies  below  the  lead  frequency  ^ the  effective  compensation 
appears  close  to  a unity  gain  with  no  dynamics.  For  frequencies  above 
the  lead  frequency  u>d  but  still  below  the  lag  frequency  ojg  the  compensation 
appears  like  the  zero  (1  + s/o;d),  thus  achieving  differentiation  and  phase 
lead.  Above  the  lag  frequency  the  filter  looks  like  pure  gain  w /a^  with 
no  phase  lead.  The  lag  [>ole  reflects  practical  constraints  on  differentiating 
signals.  It  also  offers  a way  of  limiting  the  phase  lead  to  where  it  is 
needed. 

The  second  block  diagram  is  functionally  equivalent  to  the 
first  but  has  been  redrawn  to  separate  the  lead  frequency  parameter  prior 
to  the  root  locus  procedure. 

1‘igure  \ 11-2  t shows  a two  stage  root  locus  process  to 
examine  the  effects  of  rate  lead  compensation.  The  first  root  locus 
begins  with  the  poles  of  the  pure  position  error  system  and  the  pole  of  the 
lead  compensator.  Here  a specific  value  of  position  error  gain  K and 
compensator  pole  frequency  tcg  is  assumed.  The  lead  frequency  loop  is 
assumed  to  be  open,  i.  e.,  1 u!d  - 0.  The  motion  of  the  poles  is  examined 
for  increasing  rate  feedback  gain  K^.  This  determines  the  poles  of  the 
subsystem  contained  in  the  outer  dotted  line  box  of  Figure  VII-22b.  1'sing 
this  locus  a value  of  Kr  is  now  chosen  to  fix  the  poles,  and  the  next  stage 
of  the  root  locus  procedure  proceeds.  The  new  feedback  path  is  represented 
by  the  gain  s "r/u;d  in  Figure  V 11-22.  Since  has  just  been  determined, 
this  locus  depends  only  on  l/ajd  as  the  varying  parameter.  The  root  locus 
shows  that  for  a range  of  W(J  the  resonant  poles  have  been  damped  as  the  poles 
converge  on  t.ie  real  axis.  However,  increasing  l/tc'd  (decreasing  ^«  ) further 
will  ultimatediy  only  slow  the  system  down  as  the  poles  move  closer  to  the 
origin.  Obviously  the  exact  path  of  the  resonant  poles  will  depend  on  the 
values  of  the  open  loop  poles  and  zeros.  For  certain  values  the  resonant 
poles  may  move  directly  toward  the  origin  without  damping  first.  Work  is 
needed  in  this  area  to  determine  how  best  to  design  the  rate  feedback  lead 
compensator. 

Figure  VII-24  shows  a simulation  of  the  same  non-linear 
system  using  position  feedback  and  lead  compensation  on  rate  feedback.  The 
performance  has  improved  considerably. 
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closed  loop  poles  as  increases. 

Figure  VII -23 

Root  Locus  of  Position  Feedback  with  Lead  Filter  on  Rate  Feedback 
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Simulated  Step  Response  I sit 
Position  Feedback  and  l.ead 
Compensation  Hate  Feedback 


d.  Position,  rate,  and  p-  essure  feedback 

In  the  previous  section  it  was  explained  that  acceleration 
feedback  would  damp  the  resonant  poles.  Besides  lead  compensation  on 
the  rate  signal,  another  way  to  obtain  an  acceleration  signal  is  to  use 
pressure  feedback.  Pressure  sensors  are  placed  on  both  sides  of  the 
actuator  and  used  to  measure  the  pressure  difference  acting  on  the  rotary 
vane.  Because  this  pressure  drop  is  proportional  to  the  torque  of  the 
actuator,  and  because  torque  on  an  inertial  load  is  proportional  to  accelera- 
tion, then  this  pressure  drop  can  be  taken  as  proportional  to  the  load 
acceleration. 


Figure  V 11-25  shows  a block  diagram  indicating  the  use 
of  position,  rate,  and  pressure  feedback.  Also  in  the  figure  is  a root  locus 
indicating  how  the  poles  move  for  increasing  pressure  feedback  gain  for  a 
given  set  of  position  and  rate  feedback  gains.  It  can  be  seen  that  increasing 
pressure  feedback  will  tend  to  increase  the  frequency  (speed  up)  of  the 
dominant  real  pole— up  to  a point.  Excessive  pressure  feedback  will  then 
bring  lightly  damped  low  frequency  resonant  poles. 

An  alternative  way  to  conceive  of  pressure  feedback  is  to 
think  of  the  pressure  loop  as  creating  a pressure  or  torque  servo  in  the 
middle  of  the  entire  system.  Then  the  position  error  and  rate  signal  can 

be  thought  of  as  driving  a torque  source  in  a stable,  conventional  position 
servo. 

Finally,  Figure  VII- 26  shows  a step  response  of  the 
simulated  system  using  an  appropriate  amount  of  pressure  feedback. 

Notice  that  the  response  is  smooth,  quick,  and  without  oscillation. 

4.  Discussion 

When  position,  rate,  and  pressure  feedback  are  all  used,  then 
there  are  three  parameters  to  adjust  in  the  simplified  third  order  system. 
Theoretically,  it  should  be  possible  to  arbitrarily  assign  the  three  pole 
positions  and  compute  the  required  position,  rate,  and  pressure  gains  to 
achieve  them. 
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PRESSURE  LOOP 
(a)  Block  Diagram. 


Figure  VII-25 

Position,  Rate,  and  Pressure  Feedback 
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This  technique  was  tried  with  the  simulation  program.  Using 
he  simplified  model,  gains  were  chosen  which  were  used  in  the  non-linear 

The  ""*•  inconsistent:  whiie  certain  values  of  gains 
obviously  produced  reasonable  performance  ,as  was  shown  in  the  preced  „g 

see  ion  on  pressure  feedback),  it  was  . ,,  always  possible  to  obtain  desired 
performance.  Apparently,  the  simplified  model  was  too  simple  to  use  this 
way  when  trying  to  specify  high  control  frequencies  and  speed  up  the  response 
Of  the  control  system.  Certain  higher  frequency  dynamic  components  of 
the  control  system  begin  to  influence  the  behavior  of  the  low  frequency 
pohis  of  the  simplified  model.  In  particular,  the  hydraulic  valve  dynamic, 
and  the  angle  sensing  resolver  dynamics,  both  included  in  the  computer 
simulation  have  detrimental  effects.  Also,  the  non-linearities  included 
he  simulation  may  be  responsible  for  some  of  the  problems.  Here  a 
more  sophisticated  pole  placement  technique  including  the  valve  and 
resolver  dynamics  is  required.  The  simplified  technique  does  seem  to 
give  satisfactory  results  for  control  frequency  bandwidths  less  than  101  iz 
when  used  in  conjunction  with  the  simulation  program.  Since  at  this  time 
is  not  believed  that  control  frequencies  above  10Hz  are  necessary  or 

even  desirable,  then  the  simplified  design  technique  should  prove  adequate 
when  used  with  the  simulation  program. 

It  would  be  desirable  to  check  the  simulation  program  with 

TZZT  ft’  W°rk  'hiS  ‘S  ^ experimental 

equipment  includes  a commercial  rotary  vane  actuator,  hydraulic  supply 

nT  aC?U";“lal0r-  inerUa'  mounted  on  actuator,  a potentiometer 
in  ,h  , dbaCk’  a tachometer  for  rate  feedback,  pressure  sensors 
the  actuator,  and  electronics  for  breadboarding  control  systems.  The 

qualitative  performance  of  the  types  of  control  systems  discussed  above  has 
been  tested  and  verified.  In  particular,  the  addition  of  pressure  feedback 
was  seen  to  greatly  improve  performance.  Present  work  is  concerned 
with  two  areas:  First,  quantitative  comparison  of  simulation  and 
experiment.  Difficulties  here  include  measurement  of  hard  to  measure 
quantities,  such  as  effective  fluid  modulus  and  the  presence  of  effect,  in 
the  experimental  equipment  no,  represented  in  the  model  of  the  manipulator 
actuators.  In  particular,  the  commercial  rotary  actuator  used  has  seals 
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with  rubbing  contac,.  leading  to  significant  stiction  effects.  This  type  of 
friction  was  not  included  in  the  simulation.  The  second  primary  area  of 
work  is  the  addition  of  computer  control.  A PDP9  with  A/D  and  D/A 
equipment  is  being  used  to  experiment  with  the  problems  of  computer 
control,  such  as  update  rates  of  command  and  measurement. 

Other  possibilities  for  future  work  in  this  area  include  the 
use  of  more  sophisticated  signal  filters  called  observers.  Their  function 
is  to  use  the  measured  signals,  such  as  rate  signal  or  electric  current 
through  the  valve,  to  estimate  needed  signals  that  are  not  measured,  such 
as  pressure  r rop  in  the  actuator.  This  could  be  very  helpful  since  not 
only  can  pressure  sensors  be  expensive,  but  they  also  require  additional 
design  work  on  the  actuators  and  instrumentation  circuitry  to  read  them. 
Some  preliminary  simulation  work  has  shown  that  a pressure  observer 
designed  on  the  basis  of  the  simplified  linearized  model  can  work  well  for 
estimating  pressure  in  the  non-linear  simulation  but  only  when  operating 
m regions  where  the  linear  model  is  most  accurate.  When  the  actuator 
system  is  operating  outside  this  region  the  observer  performance 
deteriorates.  Consequently,  control  schemes  which  would  use  observers 
in  place  of  genuine  sensors  would  also  deteriorate.  Work  here  has 
proceeded  only  in  analysis  and  simulation.  Experiments  will  be  done  when 
additional  electronic  hardware  is  available. 

E.  Hydraulic  Control  Servo  Experiments 

In  support  of  the  theoretical  work  in  the  previous  part  of  this 
section,  we  have  an  ongoing  program  of  hydraulic  control  experiments. 

The  apparatus  is  illustrated  in  Figure  VI1-27.  It  consists  of  a hydraulic 
power  supply,  a commercial  rotary  vane  actuator,  position  and  rate 
sensors,  and  servo  electronics.  The  apparatus  can  be  operated  from  a 
signal  generator  or  under  computer  control.  So  far  the  experiments  have 
been  utilized  to  verify  our  models  of  rotary  vane  actuators  and  to  provide 
values  for  physical  constants  for  use  in  computer  simulations.  Work 
under  way  is  aimed  at  testing  out  the  various  control  configurations 
outlined  above.  Wo-k  with  pressure  sensors  has  been  completed  and 
their  stabilizing  properties,  as  predicted  by  the  theory,  have  been  amply 
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Vr?ed:„  Ihe  4,80  8h0»8  * -egree  of  freedom  force  sensor 

lith  ,’he  b U,lUZed  " f°rCe  feCdbaCl<  SCrV°  eXPeHments  *"  connection 

h the  above  mentioned  companion  NSP  funded  work. 
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VIIL  £PnsLUSIONS  and  recommendations  for  further  work 
A.  Conclusions 

This  report  contains  three  major  themes: 

• development  of  a science  of  manipulator 
design 

• linking  that  science  with  the  problem 
of  industrial  assembly 

• study  of  a particular  arm  geometry  to 
determine  the  technological  requirements 

for  high  performance  and  operational  reliability 

The  contributions  to  manipulator  design  science  cover  aspects  of 
geometry,  kinematics,  actuators,  servo  controls,  structure,  sensors 
and  task  execution  strategies.  It  has  been  shown  that  these  aspects  of 
arm  design  and  use  interact  strongly  and  must  be  considered  together 
in  formulating  a design.  New  design  tools  have  been  developed  for 
achieving  this.  The  impetus  for  any  design  problem  must  be  a goal  for 
the  proposed  system.  Our  efforts  were  directed  at  the  problem  of 
industrial  assembly,  where  economic  and  technological  success  demand 
high  performance  arms  - arms  with  strength,  high  speed,  high  accuracy 
and  resolution,  and  rapid,  efficient  use  of  sensory  information.  This  set 
of  requirements  was  combined  with  a particular  choice  of  scale  to  produce 
the  geometry  which  was  studied  in  detail  and  to  focus  on  problems  which 
arise  in  other  scales,  such  as  mini-robot.  Because  of  this  emphasis  the 
design  is  simple  and  straightforward.  Thus,  its  potential  reliability  as  a 
piece  of  equipment  to  support  laboratory  expeiiments  is  much  higher  than 
commercial  or  experimental  hardware  currently  in  existence.  In  addition, 
its  capabilities  cover  a broader  spectrum  than  any  currently  existing 
laboratory  equipment.  Hence,  it  can  support  a broader  spectrum  of 
experimental  activity  or  tasks. 

The  requirements  of  assembly  have  two  aspects:  gross  motions, 
which  are  large,  rapid,  largely  free  of  sensory  feedback  and  reasonably 
well  understood,  and  fine  motions  of  two  parts  interacting  as  they  are 
assembled.  The  fine  motions  are  quite  small,  highly  dependent  on 
sensory  feedback  and  thus  far  not  well  understood  despite  some  laboratory 
assembly  demonstrations.  These  demonstrations,  both  in  private  industry 
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and  universities,  are  ad  hoc  and  pragmatic,  showing  that  a particular 
arm  (not  specifically  designed  for  assembly)  can  put  some  small,  well 
machined  smooth  parts  <ogether.  None  of  these  demonstrations  has 
produced  any  data  (except,  in  one  case,  the  completion  time,  (an 
industrial  experiment),  which  was  uneconomically  slow  by  a factor  of 
two]  shedding  light  on  the  class  of  task  attempted  in  any  of  the  following 
key  areas: 

• what  design  factors  in  the  arm 
contribute  to  or  detract  from  success 
in  the  demonstrated  task,  or  in  other 
types  of  tasks 

• what  control  strategies  work  in  this 
case  and  which  do  not  — where  else 
will  they  work 

• what  sensory  information  is  really 
necessary  to  accomplish  this  or  other 
kinds  of  tasks 

• what  forces  and  torques  are  being 
generated  during  the  demonstration 
tasks 

• what  is  needed  to  perform  these  or 
other  tasks  more  rapidly  and  reliably 

Until  a better  understanding  of  the  process  of  assembly  is  achieved,  these 
demonstrations  will  be  of  no  value  in  generating  a science  of  assembly 
capable  of  making  valid  performance  predictions  with  respect  to  arms  and 
control  strategies. 

B.  Recommendations 

Work  funded  by  NSF  is  going  on  at  the  C.  S.  Draper  Laboratory 
to  study  the  assembly  process,  classify  and  analyze  tasks,  develop  control 
strategies  and  use  the  above  to  specify  hardware  and  software  requirements 
for  industrial  assembly  systems.  In  the  course  of  this  work,  a number  of 
strategies,  models,  and  factors  influencing  success  have  emerged.  These 
models  need  to  be  tested.  The  strategies  assume  employment  of  novel 
designs  in  sensors,  servo  control  organization  and  actuators.  Details  of 
the  actuators  and  sensors  have  been  developed  during  the  current  work  and 
are  discussed  in  this  report.  To  carry  on  this  work  a high  performance 
computer  controlled  manipulator  arm  should  be  built.  Its  major  contribu- 

'NoF-RaNN  Grant  GI-39432X  and  GI-43787 
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tions  to  the  research  would  be  as  follows: 

• a high  performance  base  upon  which  to  ic<*t 
strategy  and  task  models;  design  and 
construction  of  the  arm  would  bt  sufficiently 
precise  that  extraneous  and  non-reproducible 
factors  influencing  the  experimental  results 
(structural  flexure,  sloppiness  in  transmissions, 
etc.  ) could  be  avoided. 


• an  accurate,  reproducible  test  instrument 
capable  of  executing  commanded  motions  or 
generating  commanded  forces  and  torques 
quite  precisely,  so  that  reliable  data  on  inter- 
action between  parts  could  be  obtained;  no 
such  data  presently  exist. 


• a device  which  can  be  systematically  degraded 
to  determine  the  performance  requirements  of 
strategies,  the  adequacy  of  error  analysis 
predictions  and  the  usefulness  of  low  cost 
substitutes  for  implementing  strategies  which 
would  be  by  then  well  understood. 


The  questions  of  size  and  kinematic  arrangement  of  this  arm  remain 
open.  None  of  the  design  tools  developed  or  used  in  this  research  is 
committed  to  any  particular  size  or  shape  of  arm.  On  the  contrary,  they 

are  applicable  to  most  sizes  and  all  shapes.  Two  issues  need  to  be  resolved 
before  a specific  size  and  shape  are  selected: 


1.  if  the  desired  size  is  quite  small,  then  new 
technology  may  be  required  for  actuators  and 
transmissions,  and  aspects  of  scaling  laws 
for  materials  and  other  items  need  to  be 
studied  in  more  detail 
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2.  study  on  this  design  and  on  the  assembly 
process  revealed  the  distinction  between 
gross  and  fine  motions.  Virtually  all 
existing  arms  were  designed  as  gross 
motion  devices.  We  have  determined 
that  the  requirements  for  fine  motion 
conflict  sufficiently  often  with  requirements 
for  gross  motion  to  make  feasible  the  idea 
of  having  two  'arms"  available  for  study  — 
one  capable  of  gross  motions,  accurate 
positioning  and  smooth  application  of  force, 
the  other  capable  of  fine  motions  of  high 
resolution  and  high  speed.  A frank  assess- 
ment of  the  POPEYE  design  is  that  it  will  be 
capable  of  gross  motions  and  some  fine 
motions  but  for  research  on  fine  motion  it  might 
be  better  to  ultimately  specify  a less  accurate 
arm  and  devote  resources  to  a companion 
fine  motion  device.  Thus,  while  POPEYE 
would  make  valuable  contributions  to  the  science 
of  assembly,  we  do  not  claim  at  this  time  that 
it  can  do  assembly  by  itself  or  than  it  even 
vaguely  resembles  an  industrially  satisfactory 
configuration.  Some  device  designed  with 
foreknowledge  of  assembly  requirements  is 
needed,  however,  to  advance  assembly  science. 
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Survey  of  Commercial  Industrial  Robots 


DOF 

Accuracy 

Control  System 

Price.  $ 
1972 

Floor  Area 

Corona 

4 

+ 3mm 

D. C.  Servo-Mag  Tape 

15K 

800xt000  mm 

Fujlkosbl 

4 

*_  1mm 

Hydr.  Cjl.-Mag  Tape 

- 

1530x730  mm 

Hawker  Slddeley 

3 

+ 3mm 

Hydr.  -Computer 

37. 5K 

1188x711  mm 

How  a 

5 

+ 1.  Omm 

EL- Hydr. 

- 

1380x900  mm 

Kawauchl 

Tekko 

S 

+ 1.  Omm 

Hydr.  -Mag  Tape 

2.  8K 

1300x750  mm 

Kojin 

s 

♦ 2.  Omm 

Hydr.  -May  Tape 

1 IK 

650x1270  mm 

Liberator 

4 

+ 0. 4mm 

Elect-Hydr. 

20 

to 

25K 

1320x610  mm 

Sc  he  Inman 

6 

♦ 1. 3mm 

D.  C.  Motors 

10K 

Sunatrand 

5 

+ .3mm 

EL.  Motor-Mag  Tape 

21 

to 

3 OK 

410x410  mm 

Teaa 

3 

. 1mm 

D.  C.  A Stepper- 
Mag  Tape 

- 

750x750  mm-rontrol 
600x600  mm- Arm 

Tokyo  Kelkl 

6 

♦ 1mm 

Hydr.  (A  to  D) 

12.  5K 

1900x1300  mm 

Tokyo  Sokuhan 

5 

♦_  1mm 

D.  C.  Motor- HOT 
Input 

12. 5K 

1300x1000  mm 

Tralle  Fabrlkken 

4 

* 2mm 

Hydr.  -Mag  Tape 

20K 

1 i 00x7 5 3 mm 

Vcraatran 

4 

0.  8rr.m-l 
ho  re  vert 

Hydr.  - Mag 

12 

to 

23K 

Unimat  a 

6 

+ 2mm 

Hydr. -Mag  Tape 

37.  5K 

1500x  1500-arm 
1200x4 50-control 
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Derivation  and  Simplification  of  Hydraulic 
System  liquations 


We  begin  the  derivation  by  discussing  the  nature  of  the  flow  through 
the  valve  orifices.  For  any  given  valve  opening,  the  pressure  drop  across 
either  orifice  is  ideally  proportional  to  the  square  of  the  flow  through  the 
orifice  with  the  sense  of  the  pressure  drop  in  the  direction  of  the  flow. 

The  proportional  constant  varies  with  t lie  area  of  the  orifice  opening  so 
that  a flow-pressure  relationship  is  obtained  as  illustrated  in  Figure  All-1 
Notice  that  for  the  largest  valve  orifice  opening,  corresponding  to  valve 
spoolposition  xg  = 1.0,  the  greatest  flow  is  obtained  for  any  given 
pressure  drop.  When  the  valve  is  closed,  - 0,  there  is  of  course  no 
flow  no  matter  what  the  pressure  drop  AP.  In  the  fallowing  derivation 
the  orifice  flow  function  will  be  expressed  as 

q = fq(xs,AP) 

where  q = flow  through  orifice 

AP=  pressure  drop  across  orifice 

Xg  = valve  spool  position,  relative  to  full  travel 


When  the  orifice  is  ideal  the  flow  function 


Vv  ^ Kv 
-Kv 


xs  flAPI 


for  AP  > 0 
for  AP<  0 


All-1 


In  the  non-linear  simulation  program  the  ideal  flow  functjpn  is  used. 

The  fluid  capacitance,  or  compliance,  in  either  actuator  chamber 
is  proportional  to  the  volume  and  inversely  proportional  to  the  effective 
fluid  modulus 

Cj(e)  = Vj(e) 

"7  All-2 

c2<e)  - v2(0) 

~ir~ 


Preceding  page  blink 
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Figure  All  - 1 

Ideal  \ alve  Orifice  Pressure/ Flow 
Relationship 


q:  flow 

- P:  pressure  drop 

V valve  spool  position  (size  of  orifice) 
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where  C^(0)  = fluid  capacitance  in  left  chamber  of  Figure  V II- 1 6 

CgfQ)  = fluid  capacitance  in  right  chamber 

Vj(0)  = actuator  fluid  volume  on  left  side  of  actuator 
vane  in  Figure  VII-16 

V2<0)  - actuator  fluid  volume  on  right  side 
3 = effective  fluid  modulus 

Notice  that  the  volume,  and  therefore  capacitance,  of  the  fluid  on  one  side 
of  the  vane  is  a function  of  the  position  of  the  vane. 

The  rate  of  change  of  pressure  in  either  chamber  is  equal  to  the  net 
flow  into  the  chamber  divided  by  the  fluid  capacitance  of  the  chamber.  The 
net  flow  into  the  left  hand  chamber  is 

'qL  ' qV  + ql 

where  = actuator  leakage  flow  from  left  chamber  to  right 

qy  = apparent  flow  due  to  displacement  of  the  actuator  vane 
q^  = flow  through  the  left  hand  orifice 

The  net  flow  into  the  right  chamber  is 

+qL  + qv  - q2 

where  q2  = flow  through  the  right  hand  orifice. 

Consequently  the  equations  for  pressure  rate  are 
dPl  1 

~ar  = UT^("qL"qv  + qi] 

Ail- 3 

d P2  1 

“cTT  = rp0)  (+qL  + qV  " q2] 

We  now  derive  expressions  for  these  flows.  The  leakage  flow  q^ 
past  the  actuator  vane  can  be  expressed  as 


where  is  the  leakage  resistance. 

The  effective  flow  due  to  motion  of  the  actuator  vane  is  the  rate  at 
which  the  vane  appears  to  displace  volume. 


= 010  All-5 

where  D = displacement  of  actuator  vane 
05  = rate  of  rotation  of  vane 

The  flows  through  the  va've  orifices  can  be  expressed  in  terms  of 
the  orifice  flow  function. 


where  P = P 
u s 

PD  = PE 


Pu  ■ PEi 

PD*  Ps  i 


for  x — 0 

s 


for  x < 0 
s 


ql  = fq(V  Pu  - Pl> 
q2  : fq<V  P2  - PD> 


AU-6 


AH- 7 


Equations  All-7  wnich  are  discussed  in  Section  VII-D,  indicate  which 
orifice  is  connected  to  supply  pressure  and  which  is  connected  to  exhaust 
pressure.  This  depends  on  the  valve  spool  position  xg.  Substituting  these 
expressions  for  the  flows  into  equations  All-3  we  obtain  the  non-linear 
chamber  equations 


dPl  . 1 

~ar  r^Tei  jj 


dPr, 


1 


Pl-?2 

p,-p„ 


Etd 


~3T  ~ rje)  j_+  ~T5~  + ’ U*-  Po  - PrJ 


W Pu  ■ P!1] 

] 


All- 8 


subject  to  constraint  equations  All-7.  Notice  that  these  equations  are 
non-linear  not  only  because  of  the  non-linear  flow  functions  f , but  also 
because  the  capacitances  Cj  and  C2  vary  with  the  position  oflhe  vane. 
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We  now  consider  the  effect  of  an  inertial  load  imposed  on  the 
actuator.  The  characteristic  equation  of  the  load  is 

I ^7  - torque  on  load  DfPj-l^)  All-9 


where  1 - rotary  inertia  of  load  which  is  equivalently  expressed  as  follows 


du> 

Tit 

d0 

dt 


I) 


(P 


1 


Cl' 


All-10 


Now  we  finally  can  present  the  set  of  non-linear  equations  for  a rotary 
hydraulic  actuator  and  load: 


aPl  1 

“Hr  “ ^ 


1 


w 


dPr 


Ht“  * TJo) 


p -p 
1 1 2 


R 


1. 


p -p 
1 2 


“ + fq  <V  1VP1) 


^ (Xs’  l>2~Pd 


dcu  - P / p _ p \ 

nr  ~ t J i 1 2 

de 

TTt  ‘ w 


where  P - P 
u s 


\ 


P = P i 
1 D E ) 


for  xs  - 0 


All-11 


P = P,, 
u E 

PT  = P 
D s 


for  x <0 
s 


These  equations  can  be  simplified  to  a linear  form  by  making  a 
series  of  assumptions  as  discussed  in  Section  V1I-D.  They  are 
essentially  the  following: 

1.  Cj(9)  = c2(e>  = c 

2.  q,‘VvPI’PKs:,s 

^2  = fq  <xs’  P2"PD)~  Ksxs 
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3.  AP 


Substitution  of  these 


relations  in  the  non-linear  equations  All-11  gives: 


dPl  1 

nr  r 

dP2  1 

nr  r 


d co 


AP 


R 


L 


- + K x 


s s 


AP 

1 TT“  + U-0  " K X 

L kl  s s 


d A „ 

■at  t A1 


All-12 

All-13 

All-14 


Notice  that  the  number  of  necessary  equations  has  been  reduced  by  one 
because  0 no  longer  plays  a part  in  the  functional  relationships.  Further- 
more, the  second  equation  (AH- 13),nay  be  subtracted  from  the  first 
(All- 12)  to  yield 


dAP  1 2 A P 


2Du:  + 2K  x 
s s 


All -15 


or,  in  matrix  form, 

■ • 

AP 

co 


D 

T 


2D 

T 


'ap  ' 

" 2K 

s 

+ 

~TT 

CO 

0 

• - 

. 

All- 16 


Notice  that  the  system  order  is  again  reduced  by  one  because  the  pressure 

difference  AP  is  the  important  variable,  noi  the  values  of  the  pressures 
themselves. 


175 


Appendix  III 


Abstracts  of  Theses  Performed  Under  this  Contract 

a.  "A  General  Planar  Positioning  Device"  by 
Jonathan  David  Hock 

b.  "Design  of  an  Automatic  Assembly  System  Multipurpose 
End  Effector",  by  Thomas  Barry  Lyons 


Preceding  page  blank 
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A GENERAL,  PLANAR 


POSITIONING  DEVICE 
by 

JONATHAN  DAVID  ROCK 


Submitted  to  the  Department  of  Mechanical  Engineering 

on 

June  17,  1974 

In  partial  fulfillment  of  the  requirements  for  the 
degree  of  Master ‘of  Science 


A pi  am  r positioning  device  for  small  motions  with  the  three 
degrees  of  freedom  x,  y,  and  theta  and  force  feedback  is  designed. 
Initially,  a model  for  a six  degree  of  freedom  positioning  device  is 
discussed  and  the  kinematic  equations  for  motion  are  derived. 

A preliminary  analysis  of  the  planar  positioning  device  is  made 
utilizing  a computer  program  to  determine  how  the  actuators  should  be 
positioned  so  that  maximum  forces  and  torques  can  be  exerted. 

Some  o the  commercial  actuators  and  servo-sensors  that  are 
available  are  looked  at  and  components  are  chosen.  The  positioning 
device  is  then  designed  and  analyzed,  with  layout  and  detailed  drawings 
being  includec  within.  An  alternate  method  for  obtaining  the  same  three 
degrees  of  freedom  is  considered. 

Future  research  should  include  control  strategies  for  the 
positioning  device  and  the  design  of  a six  degree  of  freedom  positioning 
device  with  force  feedback  for  small  motions. 


Thesis  Supervisor:  Daniel  E.  Whitney 

Title:  Associate  Professor  of  Mechanical 

Engineering 
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DESIGN  OF  AN  AUTOMATIC  ASSEMBLY  SYSTEM 
MULTIPURPOSE  END  EFFECTOR 
by 

THOMAS  BARRY  LYONS 

Submitted  to  the  Department  of  Mechanical  Engineering  on 

May  9,  1974 

i 

In  partial  fulfillment  of  the  requirements  for  the  degree  of 

Master  cf  Science 


A assign  of  an  end  effector  for  an  experimental  automatic 
assembly  system  is  developed.  The  operating  parameters 
of  the  system  are  explained  along  with  possible  uses.  The 
design  criteria  are  payload  - 10  Kg.  (22  lbs.),  maximum 
Daw  opening  - 10  cm  (4  inches) , maximum  dynamic  load  due 
to  normal  task  operation  = 100  Newtons  (22  lbf)  , and 
actuation  is  pneumatic  using  100  psi  shop  air.  We  also 
try  to  minimize  weight,  deflection  of  the  jaws  under  load 
and. actuation  time,  while  maximizing  strength  and  jaw 
spring  constant.  The  final  design  is  approximately  20  cm 

/o  ^eS  ^°”g'  has  a mass  of  just  over  one  kilogram 
(z.z  lbs.)  and  has  a maximum  jaw  closing  forc«  of  over 
445  Newtons  (100  lbs.).  er 

A kinematic  synthesis  of  a gripper  whose  jaws  remain 
parallel  and  whose  jaw  tips  move  in  a straight  line  is 
ciscussed  and  laid  out  graphically.  Compliance  of  the 
system  is  analyzed  for  various  loading  conditions.  This 
design  is  compared  to  a parallelogram  gripper  and  a 
sliding  mechanism  gripper,  showing  the  benefits  and  draw- 
bacxs  of  each.  The  input  stroke  of  the  pneumatic  actuator 
is  related  to  the  position  of  the  jaws  and  overall  serine 
constant  of  the  unit.  The  actuation  system  for  the  end 
efrector  is  analyzed  and  various  gripping  surfaces  are 
discussed.  Detailed  working  drawings  are  included. 


Thesis  Supervisor: 
Title: 


Daniel  E.  Whitney 

Associate  Professor  of  Mechanical 

Engineering 
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